EP4222465A1 - Vorrichtung und verfahren zur ermittlung einer auf einen körper wirkenden kraft in wenigstens drei raumrichtungen und verfahren zur ansteuerung der bewegung eines körpers - Google Patents

Vorrichtung und verfahren zur ermittlung einer auf einen körper wirkenden kraft in wenigstens drei raumrichtungen und verfahren zur ansteuerung der bewegung eines körpers

Info

Publication number
EP4222465A1
EP4222465A1 EP21777728.3A EP21777728A EP4222465A1 EP 4222465 A1 EP4222465 A1 EP 4222465A1 EP 21777728 A EP21777728 A EP 21777728A EP 4222465 A1 EP4222465 A1 EP 4222465A1
Authority
EP
European Patent Office
Prior art keywords
individual
sensor element
force
sensor elements
force acting
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
EP21777728.3A
Other languages
English (en)
French (fr)
Inventor
Hendrik Susemihl
David Reger
Kevin Deutmarg
Till Staude
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Neura Robotics GmbH
Original Assignee
Neura Robotics GmbH
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Neura Robotics GmbH filed Critical Neura Robotics GmbH
Publication of EP4222465A1 publication Critical patent/EP4222465A1/de
Pending legal-status Critical Current

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01L—MEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L5/00—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes
    • G01L5/22—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes for measuring the force applied to control members, e.g. control members of vehicles, triggers
    • G01L5/226—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes for measuring the force applied to control members, e.g. control members of vehicles, triggers to manipulators, e.g. the force due to gripping
    • G01L5/228—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes for measuring the force applied to control members, e.g. control members of vehicles, triggers to manipulators, e.g. the force due to gripping using tactile array force sensors
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01L—MEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L5/00—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes
    • G01L5/16—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes for measuring several components of force
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/085—Force or torque sensors
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1628—Programme controls characterised by the control loop
    • B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01L—MEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L5/00—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes
    • G01L5/22—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes for measuring the force applied to control members, e.g. control members of vehicles, triggers
    • G01L5/226—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes for measuring the force applied to control members, e.g. control members of vehicles, triggers to manipulators, e.g. the force due to gripping
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/40—Robotics, robotics mapping to robotics vision
    • G05B2219/40586—6-DOF force sensor

Definitions

  • the invention relates to a device and a method for determining a force acting on a body in at least three spatial directions and a method for controlling the movement of a body.
  • the object of the invention is therefore to provide a device and a method for determining a force acting on a body in at least three spatial directions and, in particular, based thereon, a method for controlling a body, by means of which the forces applied to the body can be recorded in such a way that that a learning or programming process of the body is made possible in a simple way.
  • the object of the invention is achieved by a device for determining a force acting on a body in at least three spatial directions with the features of patent claim 1, a method for determining a force acting on a body in at least three spatial directions with the features of patent claim 13 and a Method for controlling the movement of a body with the features of patent claim 15.
  • the device according to the invention for determining a force acting on a body, in particular a manipulator such as an industrial robot or a cobot, in at least three spatial directions has at least one sensor element for attachment to the surface of the body, which comprises at least three individual sensor elements, with each individual sensor element is designed to determine an individual force in one direction, or which comprises at least one individual sensor element, which is designed to determine an individual force in three spatial directions, and further comprises an evaluation/control unit, which detects the individual force determined by each individual sensor element and which is designed for this purpose is to calculate the force acting on the sensor element in at least three spatial directions by projecting the individual forces onto a virtual point of the sensor element.
  • the sensor element is designed and suitable for being attached to the surface of the body, it is possible to directly measure the forces applied to the body, in particular directly at the point at which the force is applied. I'm exactly one Sensor element arranged on the surface of the body, the force acting on the sensor element corresponds to the force acting on the body.
  • a single individual sensor element is sufficient.
  • individual sensor elements which are designed to determine an individual force in one direction
  • at least three individual sensor elements are arranged in one sensor element, with the directions in which the three individual sensor elements determine an individual force preferably being arranged perpendicular to one another in order to determine the To be able to allow force in three spatial directions in a simple way.
  • Each sensor element preferably comprises a plurality of, preferably at least 15, particularly preferably at least 20, individual sensor elements, as a result of which the accuracy of the determination of the force acting on the sensor element can be increased.
  • the individual sensor elements are advantageously arranged in a grid or a polar arrangement, which can simplify the determination of the force acting on the sensor element.
  • the individual sensor elements of each sensor element have at least two groups of individual sensor elements, which can be evaluated independently of one another. This enables redundant evaluation in order to be able to meet safety requirements.
  • the individual sensor elements of each group are preferably arranged in each case in a grid or a polar arrangement, with the grids or the polar arrangements preferably being arranged in an interlocking manner and being designed, for example, in the manner of a chess board. A particularly good redundancy can thereby be achieved.
  • the device comprises at least two sensor elements, which are preferably arranged at a distance from one another, particularly preferably on two opposite sides of the surface of the body.
  • the sensor elements can preferably be evaluated independently of one another, as a result of which further redundancy can be achieved.
  • the sensor element has a cover that is freely mounted relative to the sensor element.
  • a covering can enable the forces acting on the sensor element to be determined in six spatial directions.
  • the sensor element is preferably made of a flexible material which can be applied to the body in particular in the manner of a skin.
  • a flexible material also allows the sensor elements to be attached to complex body geometries. ria .
  • the application in the manner of a skin has the advantage that the sensor elements can be arranged in a space-saving manner and, in addition, operation and handling can be simplified.
  • a configuration of the sensor elements in the manner of an artificial, tactile skin enables an intuitive and rapid programming, set-up or learning process.
  • the evaluation/control unit advantageously includes a controller into which the force acting on the body can be introduced as an actual value.
  • the controller enables the applied force to be converted as well as possible into a corresponding subsequent movement of the body.
  • a body according to the invention in particular a manipulator, preferably an industrial robot or cobot, has a device according to the invention, the at least one sensor element, preferably the at least two sensor elements, being arranged on the surface of the body. Attaching the sensor element to the surface of the body enables the force applied to be determined directly.
  • the body can be moved manually in a simple manner for programming or for setting up or teaching in movements by touching the body and moving it in the desired directions by applying a force to the body itself.
  • a large number of sensor elements are arranged on the surface of the body, these covering in particular a large part of the surface, preferably the entire surface, of the body, with the sensor elements preferably being made of a flexible material which, in particular, is Kind of a skin can be applied to the body. Is the surface of the body covered extensively with sensor elements, handling can be simplified and designed to be particularly intuitive.
  • the method according to the invention for determining a force acting on a body in particular a manipulator, for example an industrial robot or cobot, in at least three spatial directions with at least one sensor element attached to the surface of the body, which comprises at least three individual sensor elements, with each individual sensor element for determining a Individual force is designed in one direction, or which comprises at least one individual sensor element, which is designed to determine an individual force in three spatial directions, and an evaluation/control unit, has the steps:
  • Such a method enables a direct measurement of the forces applied to the body, at least in three spatial directions, in particular directly at the point at which the force is applied.
  • At least two sensor elements are arranged on the surface of the body at a distance from one another, with the following steps being carried out:
  • Such a method enables a direct measurement of the forces applied to the body in six spatial directions, ie the forces X, Y, Z and the torques Rx, Ry, Rz, in particular directly at the point at which the force is applied .
  • the force acting on a body is advantageously determined independently of one another by means of two groups of individual sensor elements. This enables redundancy, which represents a safety function.
  • the method according to the invention is preferably further developed into a method for controlling the movement of a body, in particular a manipulator, for example an industrial robot or commander, with the steps:
  • Such a controller makes it possible, on the basis of an acting force that causes a deviation of the actual value of the force from the target value of the force, to movement of the body, especially in the direction of the acting force.
  • Disturbance variables are advantageously taken into account in the controller, as a result of which the desired movement can be carried out even in the event of disturbances.
  • the method according to the invention is preferably further developed into a method for controlling the movement of a body, in particular a manipulator, for example an industrial robot or commander, with the steps:
  • Such a method enables a safety function such that the movement of the body is only carried out when certain conditions are met.
  • safety-relevant release switches such as dead man's switches or confirmation switches can be implemented in this way.
  • the method according to the invention is preferably further developed into a method for controlling the movement of a body, in particular a manipulator, for example an industrial robot or commander, with the steps:
  • a method enables input and/or control commands to be entered into the evaluation/control unit.
  • the patterns can have any force profile, for example tapping twice within a specified period of time, and can result in a pre-programmed command stored in the evaluation/control unit, for example saving the current position of the body, in particular the manipulator, or the operation Release accessories attached to the body, such as input keyboards or control panels.
  • FIG. 1 shows a schematic perspective representation of an exemplary embodiment of a device according to the invention with two sensor elements
  • FIG. 2 shows a schematic representation of a controller of the device according to FIG.
  • FIG. 3 shows a schematic representation of release switching stages for the device according to FIG.
  • FIG. 4 shows a schematic perspective illustration of an alternative exemplary embodiment of a device according to the invention with a sensor element
  • FIG. 5 shows a schematic representation of a pattern of the force acting on the body 3 for a control command.
  • Figure 1 shows a schematic perspective view of an embodiment of a device 10 according to the invention for determining a force F acting on a body 3 in at least three spatial directions Fx, Fy, Fz with at least one, in the present embodiment with two sensor elements 1, 2 for attachment a surface 3 . 1 of the body 3 and an evaluation/control unit 6 .
  • the body 3 shown can be a partial segment, for example an arm or a section of an arm, of a manipulator, for example an industrial robot or a bid.
  • the body 3 can have any conceivable shape and, of course, can also have components that can be moved relative to one another.
  • the body 7 comprises a drive unit 7, by means of which the body 7 can be moved either relative to other components or relative to the ground.
  • the body 3 designed as a sub-segment of an arm of a manipulator can be rotated and/or tilted relative to a further sub-segment of the arm of the manipulator.
  • the drive unit 7 can be activated by means of the evaluation/control unit 6, which can be arranged either in or on the body 3 or can be designed as a separate unit.
  • the sensor elements 1 , 2 each have a measuring surface 1 . 1 , 2 . 1, which—as shown by way of example for the sensor element 1—which individual sensor elements 1 . 3 includes .
  • the individual sensor elements 1 . 3 are either for determining an individual force in one direction, usually perpendicular to the surface of the individual sensor element 1 . 3 , or determination of a single force in three spatial directions .
  • the sensor elements 1, 2 each have at least one of the individual sensor elements 1.3, preferably a plurality of individual sensor elements 1.3.
  • the sensor elements 1, 2 each have at least three of the individual sensor elements 1.3, preferably several individual sensor elements 1.3.
  • the sensor elements 1, 2 have at least 15, for example 16, particularly preferably at least 20, in the present exemplary embodiment 24 individual sensor elements 1.3 arranged in a 4 ⁇ 4 grid.
  • a larger number of individual sensor elements 1.3 can improve the resolution, regardless of whether the individual sensor element 1.3 determines the force in one or in three spatial directions.
  • the individual sensor elements 1.3 are preferably arranged in a grid or a polar arrangement, for example as shown in the figures in rows and columns with the same grid dimensions. In particular, it is essential for the evaluation to know the relative orientation of the individual sensor elements 1.3 to one another.
  • the force acting on the sensor element 1, 2 in three spatial directions Ex, Fy, Fz can be determined in such a way that a projection of the forces acting on the individual sensor elements 1.3 onto a virtual point 1.2, 2.2 of the sensor element 1, 2 is carried out, in particular by means of the evaluation/control unit 6.
  • the virtual point 1.2, 2.2 is in particular on the measuring surface 1.1, 2.1, for example centrally.
  • the force acting on the sensor element 1, 2 in particular at the virtual point 1.2, 2.2 can be measured in three spatial directions, i.e in particular the three force components Ex, Fy, Fz can be determined.
  • Each of the two sensor elements 1, 2 described above enables the force acting on the sensor elements 1, 2 and thus also on the body 3 to be determined in three spatial directions.
  • a method for determining a force acting on the body 3, in particular a manipulator in at least three spatial directions with exactly one sensor element 1, 2 mounted on the surface 3.1 of the body 3, which comprises at least three individual sensor elements 3.1, with each individual sensor element 1.3 for determining of an individual force in one direction, or which comprises at least one individual sensor element 1.3, which is designed to determine an individual force in three spatial directions, and an evaluation/control unit 6, the following steps can then be carried out: First, each is applied to each individual sensor element 1.3 single force determined. Then the force acting on the sensor element 1, 2 in three spatial directions Ex, Fy, Fz is calculated by projecting the individual forces onto a virtual point 1.2, 2.2 of the sensor element
  • the force acting on the body 3 can be determined in a simple manner not only in three but in six spatial directions, ie the acting forces Ex, Fy, Fz and the acting torques Mx, My, Mz .
  • the sensor elements 1 , 2 can be arranged at a distance A from one another, with the sensor element 1 being able to have the distance a from a virtual point 4 of the body 3 and the sensor element 2 being able to have a distance b from the virtual point 4 of the body 3 .
  • the distance A preferably corresponds to the sum of the distances a and b.
  • the forces acting on the sensor elements 1 , 2 are projected onto the virtual point 4 of the body 3 , in particular by means of the evaluation/control unit 6 . Since the virtual point 4 is not in the measuring surface 1.1, 2.1 of the sensor elements 1, 2, but at a distance from it, by considering the position of the individual sensor elements 1.3 relative to the virtual point 4 and evaluating the absolute values of the values on the individual sensor elements 1.3 acting individual forces, in addition to the forces Ex, Fy, Fz acting in three spatial directions, the torques Mx, My, Mz acting around the axes can also be determined.
  • a method for determining a force acting on the body 3, in particular a manipulator in at least three, preferably in six, spatial directions with at least two sensor elements 1, 2 spaced apart from one another on the surface 3.1 of the body 3, each of which has at least three individual sensor elements 3.1 each individual sensor element 1.3 being designed to determine an individual force in one direction, or each comprising at least one individual sensor element 1.3 which is designed to determine an individual force in three spatial directions, and an evaluation/control unit 6, the following steps can then be carried out: First, for each sensor element 1, 2 each individual force acting on each individual sensor element 1.3 is determined. Then the force acting on the sensor element 1, 2 is calculated in three spatial directions by projecting the individual forces onto a virtual point 1.2, 2.2 of the sensor element 1, 2.
  • the forces Ex, Fy, Fz and torques Mx, My, Mz acting on the body 3 are calculated by projecting the forces acting on the sensor elements 1, 2 onto a virtual point 4 of the body 3, which in particular is spaced apart from the sensor elements 1, 2 is calculated.
  • the sensor element 1 shown there differs from the sensor element 1 shown in FIG. 1 in that it has a cover 1.4 that is freely mounted relative to the sensor element 1 and is arranged in particular parallel to the measuring surface 1.2.
  • the cover 1.4 can be fixed, for example, on the surface 1.3 of the body, but can be moved relative to the sensor element 1 and in particular to the measuring surface 1.2. A user thus grips the outer surface of the cover 1.4, but the cover 1.4 is connected to the individual sensor elements 1.3, so that the force exerted on the cover 1.4 is transmitted to the individual sensor elements 1.3 via the back of the cover 1.4.
  • the virtual point 1.2 is at a distance from the outer surface of the cover 1.4 in the measuring surface 1.2, which enables not only the three force components Ex, Fy, Fz to be determined in three spatial directions, but also the effective torques Mx, My, Mz.
  • FIG. 1 shows the sensor elements 1, 2 as planar sensor elements 1, 2, which are shown tangentially to the curved surface 3.1 of the body 3 in a non-realistic way to simplify the illustration.
  • the sensor elements 1, 2 preferably adapt to the surface 3.1 of the body 3.
  • the sensor elements 1, 2 can be made of a flexible material.
  • the sensor elements 1, 2 can be applied to the body 3 in the manner of an artificial, tactile skin.
  • a large number of sensor elements 1, 2 can be arranged on the surface 3.1 of the body 3 and in particular can cover a large part of the surface 3.1, preferably the entire surface 3.1, of the body 3.
  • a manipulated variable is preferably determined based on the force acting on the body, which the drive unit 7 converts into a corresponding movement of the body 3 in the direction of the acting force.
  • a controller 5 is preferably provided for this purpose, in particular in the evaluation/control unit 6, which is shown schematically in FIG.
  • the controller 5 is intended to carry out a subsequent movement of the body 3 in the direction of the force imbalance on the basis of the change in the force balance of the body 3 .
  • the controller 5 can comprise a controlled system 5.3 and a control device 5.4, with the control device 5.4 receiving a control difference 5.8 as an input value, which results from an actual value 5.1 and a setpoint value 5.6 in a comparison element 5.7.
  • Actual value 5.1 corresponds in particular to the force acting on body 3, which was determined using sensor elements 1, 2.
  • the target value 5.6 can be defined, for example, by the balance of forces.
  • the controlled system 5.3 delivers a controlled variable 5.2, which can specify the manipulated variable for the drive unit 7.
  • Disturbance variables 5.5 can be taken into account in the controlled system 5.3.
  • the movement of the body that is then carried out can be, for example, a linear movement or a rotary movement.
  • the center of the movement can be placed at any point of the body 3 by a kinematic transformation, for example at the virtual point 4, but also at other points.
  • the evaluation/control unit 6 and the drive unit 7 make it possible to determine one or more spatial directions, so that specific movements can be carried out in desired spatial directions.
  • the forces acting on the body are then introduced into the controller 5 as actual values 5.1, the actual values 5.1 are compared with the target value 5.6 and a manipulated variable for a movement control to achieve the target value 5.6 is determined in order to determine a method for controlling the movement of the body 3 to provide.
  • disturbance variables 5.5 in particular in the controlled system 5.3, can also be taken into account in the controller 5.
  • Data and signal transmission between all components can be wired or wireless.
  • all of the individual sensor elements 1.3 can be used for the evaluation. There is also the possibility of dividing the individual sensor elements 1.3 into two groups of individual sensor elements 1.3', 1.3'', the group of the individual sensor elements 1.3', which is illustrated in FIG. 1 without hatching, being independent of the group of the individual sensor elements 1.3''. , which is shown in Figure 1 for illustration with hatching, can be evaluated, for example, to enable a redundant evaluation.
  • the individual sensor elements 1.3′, 1.3′′ in each group are preferably each arranged in a grid or polar arrangement, the grids or polar arrangements being arranged in particular in an interlocking manner, for example in the manner of a chessboard (cf. FIG. 1 or FIG. 4).
  • each sensor element 1, 2 If there are several sensor elements 1, 2, a separate and/or independent evaluation of each sensor element 1, 2 is also possible in order to be able to carry out an additional plausibility check and, for example, to check whether a force is applied to each of the sensor elements 1, 2 and/or by a to allow further redundancy.
  • the force acting on the body can thus be determined independently of one another by means of two groups of individual sensor elements 1 . 3'. 1 . 3 '' done .
  • Typical safety-relevant release switches for movements of the body 3 can have three switching stages, namely a switching stage S1, in which the switch is not actuated, a switching stage S2, in which a movement of the body 3 is released, and a switching stage S3, in which an emergency stop takes place.
  • a minimum force value Gl and a maximum force value G2 can be defined as the lower and upper switching threshold, with the switching stage S l at a force below the minimum force value Gl, the switching stage S2 at a force between the minimum force value Gl and the maximum force value G2 and the switching stage S3 is present at a force above the maximum force value G2 (cf. FIG. 3, in which an example of the amount F of the forces acting on the sensor elements 1, 2 is plotted as a function of the time t).
  • the movement of the body 3 can be released when the amount F of the force acting on the sensor element 1, 2 is in the range of the switching stage S2 for one of the sensor elements 1, 2.
  • the safety function is improved if, as shown in FIG.
  • the movement of body 3 is released when for both sensor elements 1, 2 the amount F of the force acting on sensor element 1, 2 is in the range of switching stage S2.
  • the force acting on the body 3 can then first be determined using the sensor elements 1, 2, then the determined force, in particular the amount F of the averaged force, with a predetermined minimum force value Gl and/or a maximum Force value G2 are compared and the movement of the body 3 is released if the determined force or the amount F of the determined force is greater than the minimum force value Gl and/or less than the maximum force value G2.
  • patterns of the force acting on the body 3 for control commands can be stored in the evaluation/control unit 6, the patterns representing force profiles as a function of the time t.
  • the force acting on body 3 as a function of time t in particular the amount F of the force acting on body 3 as a function of time t , can be compared with the stored patterns in order to identify such patterns and then the corresponding ones implement control command.
  • FIG. 5 shows an example of a force profile in which the sensor element 1 is tapped twice. The force maxima occur at times t1 and t2.
  • the pattern can be recognized and the corresponding control command linked to the pattern and stored accordingly in the evaluation/control unit, for example the current position of the body 3, for example an arm of a manipulator, can be stored or operation of accessories attached to the body 3, such as an input field, can be enabled.
  • the evaluation/control unit for example the current position of the body 3, for example an arm of a manipulator
  • the body 3 can be stored or operation of accessories attached to the body 3, such as an input field, can be enabled.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Chemical & Material Sciences (AREA)
  • Analytical Chemistry (AREA)
  • Manipulator (AREA)
  • Force Measurement Appropriate To Specific Purposes (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

Die Erfindung betrifft eine Vorrichtung zur Ermittlung einer auf einen Körper (3), insbesondere einen Manipulator, wirkenden Kraft in wenigstens drei Raumrichtungen (Fx, Fy, Fz, Mx, My, Mz) mit - wenigstens einem Sensorelement (1, 2) zur Anbringung auf der Oberfläche (3.1) des Körpers (3), welches wenigstens drei Einzelsensorelemente (1.3) umfasst, wobei jedes Einzelsensorelement (1.3) zur Ermittlung einer Einzelkraft in einer Richtung ausgebildet ist, oder welches wenigstens ein Einzelsensorelement (1.3) umfasst, welches zur Ermittlung einer Einzelkraft in drei Raumrichtungen ausgebildet ist, - und einer Auswerte-/Steuereinheit (6), welche die von jedem Einzelsensorelement (1.3) ermittelte Einzelkraft erfasst und welche dazu ausgebildet ist, die auf das Sensorelement (1, 2) wirkende Kraft in wenigstens drei Raumrichtungen (Fx, Fy, Fz, Mx, My, Mz) durch Projektion der Einzelkräfte auf einen virtuellen Punkt (1.2, 2.2) des Sensorelements (1, 2) zu berechnen. Ferner betrifft die Erfindung ein Verfahren zur Ermittlung einer auf einen Körper (3) wirkenden Kraft in wenigstens drei Raumrichtungen sowie ein Verfahren zur Ansteuerung der Bewegung eines Körpers (3).

Description

Vorrichtung und Verfahren zur Ermittlung einer auf einen Körper wirkenden Kraft in wenigstens drei Raumrichtungen und Verfahren zur Ansteuerung der Bewegung eines Körpers
Die Erfindung betri f ft eine Vorrichtung und ein Verfahren zur Ermittlung einer auf einen Körper wirkenden Kraft in wenigstens drei Raumrichtungen sowie ein Verfahren zur Ansteuerung der Bewegung eines Körpers .
Zum Programmieren sowie zum Einrichtbetrieb von Körpern, insbesondere Manipulatoren wie beispielsweise Industrierobotern oder Gebots , ist eine manuelle Bewegung dieser Körper durch Aufbringen einer Kraft auf den Körper selbst oder auf ein entsprechendes Eingabegerät an dem Körper erforderlich . Dabei ist bei vielen Anwendungen die Sensitivität oder Feinfühligkeit des j eweiligen Eingabegeräts zum Aus führen der Bewegung ein limitierender Faktor . Darüber hinaus weisen aktuelle Lösungen bedingt durch das Messprinzip zur Erfassung einer Kraft eine von der Stellung des Körpers abhängige Sensitivität auf .
Da Manipulatoren häufig diverse Freiheitsgrade aufweisen, ist die simultane Ansteuerung all dieser Achsen in interpolierten, kartesischen Bewegungen in allen sechs Freiheitsgraden (X, Y, Z , Ry, Ry, Rz ) von großer Bedeutung, um den Programmierprozess schnell und intuitiv zu gestalten . Aktuelle Lösungen können dies bisher nicht abbilden .
Bekannt ist derzeit , die Motorströme , welche zur Bewegung einzelner Achsen eines Körpers , insbesondere Manipulators , erforderlich sind, zu messen und die j eweils an den Achsen anliegenden Drehmomente daraus zu berechnen . Durch Subtraktion der benötigten Haltemomente können Änderungen, die durch auf die Achsen aufgebrachte Kräfte entstehen, errechnet und in Folge- bewegungen umgewandelt werden . Nachteilig dabei ist j edoch, dass die auf den Körper eingebrachten Kräfte lediglich indirekt gemessen werden . In Abhängigkeit von der Stellung des Körpers , insbesondere Manipulators , können unterschiedlich große Hebelwirkungen entstehen, die die Sensitivität der Lösung inhomogen über den Arbeitsraum verteilen .
Alternativ ist es auch bekannt , die Drehmomente an den j eweiligen Achsen durch in den Achsen verbaute Drehmomentsensoren direkt zu messen und Änderungen des Drehmoments , die durch auf die Achsen aufgebrachte Kräfte entstehen, in Folgebewegungen umzusetzen . Nachteilig bei diesem Verfahren ist j edoch ebenfalls , dass die auf den Körper eingebrachten Kräfte lediglich indirekt gemessen werden und in Abhängigkeit von der Stellung des Körpers , insbesondere Manipulators , unterschiedlich große Hebelwirkungen entstehen können . Darüber hinaus müssen an j eder Achse Drehmomentsensoren angebracht werden, was zu hohen Kosten führen kann .
Weiterhin ist auch bekannt , an dem Körper 3D-Joysticks anzubringen, um in Freiheitsgraden begrenzte Bewegungen aus führen zu können . Dabei können j edoch nur einzelne kartesische Richtungen gleichzeitig angesteuert werden, was die Bewegungsmöglichkeiten stark einschränkt .
Die Aufgabe der Erfindung besteht daher darin, eine Vorrichtung und ein Verfahren zur Ermittlung einer auf einen Körper wirkenden Kraft in wenigstens drei Raumrichtungen sowie insbesondere beruhend darauf ein Verfahren zur Ansteuerung eines Körpers bereitzustellen, mittels welcher die auf den Körper eingebrachten Kräfte derart erfasst werden können, dass ein Einlern- oder Programmierprozess des Körpers auf einfache Art und Weise ermöglicht wird . Die Aufgabe der Erfindung wird gelöst durch eine Vorrichtung zur Ermittlung einer auf einen Körper wirkenden Kraft in wenigstens drei Raumrichtungen mit den Merkmalen des Patentanspruchs 1 , ein Verfahren zur Ermittlung einer auf einen Körper wirkenden Kraft in wenigstens drei Raumrichtungen mit den Merkmalen des Patentanspruchs 13 sowie ein Verfahren zur Ansteuerung der Bewegung eines Körpers mit den Merkmalen des Patentanspruchs 15 .
Vorteilhafte Ausgestaltungen und Weiterbildungen der Erfindung sind in den abhängigen Ansprüchen angegeben .
Die erfindungsgemäße Vorrichtung zur Ermittlung einer auf einen Körper, insbesondere einen Manipulator wie beispielsweise einen Industrieroboter oder einen Cobot , wirkenden Kraft in wenigstens drei Raumrichtungen weist wenigstens ein Sensorelement zur Anbringung auf der Oberfläche des Körpers auf , welches wenigstens drei Einzelsensorelemente umfasst , wobei j edes Einzelsensorelement zur Ermittlung einer Einzelkraft in einer Richtung ausgebildet ist , oder welches wenigstens ein Einzelsensorelement umfasst , welches zur Ermittlung einer Einzelkraft in drei Raumrichtungen ausgebildet ist , und umfasst weiterhin eine Auswerte-/Steuereinheit , welche die von j edem Einzelsensorelement ermittelte Einzelkraft erfasst und welche dazu ausgebildet ist , die auf das Sensorelement wirkende Kraft in wenigstens drei Raumrichtungen durch Proj ektion der Einzelkräfte auf einen virtuellen Punkt des Sensorelements zu berechnen . Dadurch, dass das Sensorelement ausgebildet und geeignet ist , auf der Oberfläche des Körpers angebracht zu werden, wird eine direkte Messung der auf den Körper eingebrachten Kräfte , insbesondere direkt an der Stelle , an welcher die Kraft eingebracht wird, ermöglicht . I st genau ein Sensorelement auf der Oberfläche des Körpers angeordnet , entspricht die auf das Sensorelement wirkende Kraft der auf den Körper wirkenden Kraft .
Bei Verwendung von Einzelsensorelementen, welche zur Ermittlung einer Einzelkraft in drei Raumrichtungen ausgebildet sind, ist bereits ein einziges Einzelsensorelement ausreichend . Bei Verwendung von Einzelsensorelementen, welche zur Ermittlung einer Einzelkraft in einer Richtung ausgebildet sind, werden wenigstens drei Einzelsensorelemente in einem Sensorelement angeordnet , wobei vorzugsweise die Richtungen, in welche die drei Einzelsensorelemente eine Einzelkraft bestimmen, j eweils senkrecht zueinander angeordnet sind, um eine Ermittlung der Kraft in drei Raumrichtungen auf einfache Art und Weise ermöglichen zu können .
Vorzugsweise umfasst j edes Sensorelemente mehrere , vorzugsweise wenigstens 15 , besonders bevorzugt wenigstens 20 , Einzelsensorelemente , wodurch die Genauigkeit der Bestimmung der auf das Sensorelement wirkenden Kraft erhöht werden kann .
Vorteilhafterweise sind die Einzelsensorelemente in einem Raster oder einer polaren Anordnung angeordnet , was die Bestimmung der auf das Sensorelement wirkenden Kraft vereinfachen kann . Wesentlich ist dabei insbesondere , dass die relative geometrische Anordnung der Einzelsensorelemente zueinander bekannt ist .
Eine vorteilhafte Weiterbildung der Erfindung sieht vor, dass die Einzelsensorelemente j edes Sensorelements wenigstens zwei Gruppen von Einzelsensorelementen aufweist , welche unabhängig voneinander auswertbar sind . Dies ermöglicht eine redundante Auswertung, um Sicherheitsanforderungen genügen zu können . Vorzugsweise sind die Einzelsensorelemente j eder Gruppe in j eweils einem Raster oder einer polaren Anordnung angeordnet , wobei vorzugsweise die Raster oder die polaren Anordnungen ineinandergrei fend angeordnet sind und beispielsweise nach Art eines Schachbretts ausgestaltet sind . Dadurch kann eine besonders gute Redundanz erreicht werden .
Gemäß einer besonders vorteilhaften Ausgestaltung der Erfindung umfasst die Vorrichtung wenigstens zwei Sensorelemente , welche vorzugsweise in einem Abstand zueinander, besonders bevorzugt auf zwei gegenüberliegenden Seiten der Oberfläche des Körpers , angeordnet sind . Durch eine Verwendung mehrerer Sensorelemente kann es ermöglicht werden, durch Kombination der auf die Sensorelementen ermittelten wirkenden Kräfte in wenigstens drei Raumrichtungen die auf den Körper wirkenden Kräfte in sechs Raumrichtungen, also die wirkenden Kräfte und Drehmomente , zu bestimmen .
Vorzugsweise sind die Sensorelemente unabhängig voneinander auswertbar, wodurch eine weitere Redundanz erreicht werden kann .
Gemäß einer vorteilhaften Weiterbildung der Erfindung weist das Sensorelement eine relativ zum Sensorelement frei gelagerte Abdeckung auf . Eine derartige Abdeckung kann eine Bestimmung der auf das Sensorelement wirkenden Kräfte in sechs Raumrichtungen ermöglichen .
Vorzugsweise ist das Sensorelement aus einem flexiblen Material gefertigt , welches insbesondere nach Art einer Haut auf den Körper aufbringbar ist . Ein flexibles Material erlaubt die Anbringung der Sensorelemente auch auf komplexen Körpergeomet- rien . Das Aufbringen nach Art einer Haut weist den Vorteil auf , dass die Sensorelemente platzsparend angeordnet werden können und zudem die Bedienung und Handhabung vereinfacht werden kann . Eine Ausgestaltung der Sensorelemente nach Art einer künstlichen, taktilen Haut ermöglicht einen intuitiven und schnellen Programmier- , Einricht- oder Einlernprozess .
Vorteilhafterweise umfasst die Auswerte-/Steuereinheit einen Regler, in welchen die auf den Körper wirkende Kraft als I stwert einbringbar ist . Der Regler ermöglicht eine möglichst gute Umsetzung der aufgebrachten Kraft in eine entsprechende Folgebewegung des Körpers .
Ein erfindungsgemäßer Körper, insbesondere Manipulator, vorzugsweise Industrieroboter oder Cobot , weist eine erfindungsgemäße Vorrichtung auf , wobei das wenigstens eine Sensorelement , vorzugsweise die wenigstens zwei Sensorelemente , auf der Oberfläche des Körpers angeordnet sind . Das Anbringen des Sensorelements auf der Oberfläche des Körpers ermöglicht eine direkte Bestimmung der eingebrachten Kraft . Dabei kann der Körper zum Programmieren oder zum Einrichten oder Einlernen von Bewegungen auf einfache Art und Weise manuell bewegt werden, indem der Körper angefasst und in die gewünschten Richtungen durch Aufbringen einer Kraft auf den Körper selbst verschoben wird .
Gemäß einer bevorzugten Weiterbildung der Erfindung ist eine Viel zahl von Sensorelementen auf der Oberfläche des Körpers angeordnet , wobei diese insbesondere einen Großteil der Oberfläche , vorzugsweise die gesamte Oberfläche , des Körpers bedecken, wobei vorzugsweise die Sensorelemente aus einem flexiblen Material gefertigt sind, welches insbesondere nach Art einer Haut auf den Körper aufbringbar sind . I st die Oberfläche des Körpers groß flächig mit Sensorelementen bedeckt , kann sich die Handhabung vereinfachen und besonders intuitiv gestalten lassen .
Das erfindungsgemäße Verfahren zur Ermittlung einer auf einen Körper, insbesondere einen Manipulator, beispielsweise einen Industrieroboter oder Cobot , wirkenden Kraft in wenigstens drei Raumrichtungen mit wenigstens einem auf der Oberfläche des Körpers angebrachten Sensorelement , welches wenigstens drei Einzelsensorelemente umfasst , wobei j edes Einzelsensorelement zur Ermittlung einer Einzelkraft in einer Richtung ausgebildet ist , oder welches wenigstens ein Einzelsensorelement umfasst , welches zur Ermittlung einer Einzelkraft in drei Raumrichtungen ausgebildet ist , und einer Auswerte- /Steuereinheit , weist die Schritte auf :
- Ermittlung j eder auf j edes Einzelsensorelement wirkenden Einzelkraft ,
- Berechnung der auf das Sensorelement wirkenden Kraft in wenigstens drei Raumrichtungen durch Proj ektion der Einzelkräfte auf einen virtuellen Punkt des Sensorelements .
Durch ein derartiges Verfahren wird eine direkte Messung der auf den Körper eingebrachten Kräfte zumindest in drei Raumrichtungen, insbesondere direkt an der Stelle , an welcher die Kraft eingebracht wird, ermöglicht .
Gemäß einer vorteilhaften Weiterbildung des Verfahrens sind wenigstens zwei Sensorelemente auf der Oberfläche des Körpers in einem Abstand zueinander angeordnet , wobei die folgenden Schritte durchgeführt werden :
- Ermittlung j eder auf j edes Einzelsensorelement wirkende Einzelkraft für j edes Sensorelement ,
- Berechnung der auf das Sensorelement wirkenden Kraft in wenigstens drei Raumrichtungen durch Proj ektion der Einzelkräfte auf einen virtuellen Punkt des Sensorelements für j edes Sensorelement ,
- Berechnung der auf den Körper wirkenden Kräfte und Drehmomente durch Proj ektion der auf die Sensorelemente wirkenden Kräfte auf einen virtuellen Punkt des Körpers , welcher insbesondere im Raum beabstandet zu den Sensorelementen, insbesondere zur Mess fläche der Sensorelemente , ist .
Durch ein derartiges Verfahren kann eine direkte Messung der auf den Körper eingebrachten Kräfte in sechs Raumrichtungen, also der Kräfte X, Y, Z und der Drehmomente Rx, Ry, Rz , insbesondere direkt an der Stelle , an welcher die Kraft eingebracht wird, ermöglicht werden .
Vorteilhafterweise erfolgt die Ermittlung der auf einen Körper wirkenden Kraft unabhängig voneinander mittels zweier Gruppen von Einzelsensorelementen . Dadurch wird eine Redundanz ermöglicht , die eine Sicherheits funktion darstellt .
Vorzugsweise ist das erfindungsgemäße Verfahren weitergebildet zu einem Verfahren zur Ansteuerung der Bewegung eines Körpers , insbesondere eines Manipulators , beispielsweise eines Industrieroboters oder Gebots , mit den Schritten :
- Ermittlung der auf den Körper wirkenden Kraft mit einem erfindungsgemäßen Verfahren,
- Einbringen der auf den Körper wirkenden Kraft als I stwert in einen Regler,
- Vergleich des I stwerts mit einem Sollwert des Reglers ,
- Ermittlung einer Stellgröße für eine Bewegungssteuerung zur Erreichung des Sollwerts .
Mittels eines derartigen Reglers wird es ermöglicht , auf Basis einer einwirkenden Kraft , die eine Abweichung des I stwerts der Kraft von dem Sollwert der Kraft hervorruft , eine Folgebewe- gung des Körpers insbesondere in Richtung der wirkenden Kraft durchzuführen .
Vorteilhafterweise werden in dem Regler Störgrößen berücksichtigt , wodurch auch bei Störeinflüssen die gewünschte Bewegung durchgeführt werden kann .
Vorzugsweise ist das erfindungsgemäße Verfahren weitergebildet zu einem Verfahren zur Ansteuerung der Bewegung eines Körpers , insbesondere eines Manipulators , beispielsweise eines Industrieroboters oder Gebots , mit den Schritten :
- Ermittlung der auf den Körper wirkenden Kraft mit einem erfindungsgemäßen Verfahren,
- Vergleich der ermittelten Kraft mit einem vorgegebenen minimalen Kraftwert und/oder einem maximalen Kraftwert ,
- Freigabe der Bewegung des Körpers , sofern die ermittelte Kraft größer als der minimale Kraftwert und/oder kleiner als der maximale Kraftwert ist .
Ein derartiges Verfahren ermöglicht eine Sicherheits funktion derart , dass die Bewegung des Körpers nur dann durchgeführt wird, wenn bestimmte Bedingungen erfüllt sind . Insbesondere können auf diese Weise sicherheitsrelevante Freigabeschalter wie Totmannschalter oder Bestätigungsschalter realisiert werden .
Vorzugsweise ist das erfindungsgemäße Verfahren weitergebildet zu einem Verfahren zur Ansteuerung der Bewegung eines Körpers , insbesondere eines Manipulators , beispielsweise eines Industrieroboters oder Gebots , mit den Schritten :
- Ermittlung der auf den Körper wirkenden Kraft mit einem erfindungsgemäßen Verfahren in Abhängigkeit von der Zeit , -Erkennen von Mustern der auf den Körper wirkenden Kraft für Eingabe- und/oder Ansteuerbefehle . Ein derartiges Verfahren ermöglicht die Eingabe von Eingabe- und/oder Ansteuerbefehlen an die Auswerte-/Steuereinheit . Die Muster können ein beliebiges Kraftprofil aufweisen, beispielsweise zweimaliges Tippen innerhalb eines vorgegebenen Zeitraums , und können einen in der Auswerte-/Steuereinheit hinterlegten, vorprogrammierten Befehl zur Folge haben, beispielsweise das Speichern der aktuellen Stellung des Körpers , insbesondere des Manipulators , oder können die Bedienung von an dem Körper befestigten Zubehör, beispielsweise Eingabetastaturen oder Bedienfeldern, freigeben .
Die Erfindung wird anhand der in den folgenden Figuren dargestellten Aus führungsbeispiele aus führlich erläutert . Es zeigen
Figur 1 eine schematische perspektivische Darstellung eines Aus führungsbeispiels einer erfindungsgemäßen Vorrichtung mit zwei Sensorelementen,
Figur 2 eine schematische Darstellung eines Reglers der Vorrichtung gemäß Figur 1 ,
Figur 3 eine schematische Darstellung von Freigabeschaltstufen für die Vorrichtung gemäß Figur 1 ,
Figur 4 eine schematische perspektivische Darstellung eines alternativen Aus führungsbeispiels einer erfindungsgemäßen Vorrichtung mit einem Sensorelement und
Figur 5 eine schematische Darstellung eines Musters der auf den Körper 3 wirkenden Kraft für einen Ansteuerbefehl . Figur 1 zeigt eine schematische perspektivische Darstellung eines Aus führungsbeispiels einer erfindungsgemäßen Vorrichtung 10 zur Ermittlung einer auf einen Körper 3 wirkenden Kraft F in wenigstens drei Raumrichtungen Fx, Fy, Fz mit wenigstens einem, im vorliegenden Aus führungsbeispiel mit zwei Sensorelementen 1 , 2 zur Anbringung auf einer Oberfläche 3 . 1 des Körpers 3 und einer Auswerte-/Steuereinheit 6 .
Bei dem dargestellten Körper 3 kann es sich um ein Teilsegment , beispielsweise einen Arm oder einen Abschnitt eines Arms , eines Manipulators , beispielsweise eines Industrieroboters oder eines Gebots , handeln . Der Körper 3 kann j ede erdenkliche Form aufweisen und weiterhin selbstverständlich relativ zueinander bewegbare Komponenten aufweisen . Der Körper 7 umfasst eine Antriebseinheit 7 , mittels welcher der Körper 7 entweder relativ zu anderen Komponenten oder relativ zum Boden, bewegbar ist . Beispielsweise ist mittels der Antriebseinheit 7 der als Teilsegment eines Arms eines Manipulators ausgebildeter Körper 3 gegen ein weiteres Teilsegments des Arms des Manipulators verdrehbar und/oder verkippbar . Die Ansteuerung der Antriebseinheit 7 kann mittels der Auswerte- /Steuereinheit 6 erfolgen, welche entweder in oder an dem Körper 3 angeordnet oder als separate Einheit ausgebildet sein kann .
Die Sensorelemente 1 , 2 weisen j eweils eine Mess fläche 1 . 1 , 2 . 1 auf , welche - wie beispielhaft für das Sensorelement 1 dargestellt - welches Einzelsensorelemente 1 . 3 umfasst . Die Einzelsensorelemente 1 . 3 sind entweder zur Ermittlung einer Einzelkraft in einer Richtung, in der Regel senkrecht zur Oberfläche des Einzelsensorelements 1 . 3 , oder Ermittlung einer Einzelkraft in drei Raumrichtungen ausgebildet . Bei Verwendung eines Einzelsensorelements 1 . 3 , welches zur Ermittlung einer Einzelkraft in drei Raumrichtungen ausgebildet ist, weisen die Sensorelemente 1, 2 jeweils mindestens eines der Einzelsensorelemente 1.3, vorzugsweise mehrere Einzelsensorelemente 1.3, auf. Bei Verwendung von Einzelsensorelementen 1.3, welche zur Ermittlung einer Einzelkraft in einer Richtung ausgebildet sind, weisen die Sensorelemente 1, 2 jeweils wenigstens drei der Einzelsensorelemente 1.3, vorzugsweise mehrere Einzelsensorelemente 1.3, auf.
In einer bevorzugten, optionalen Aus führungs form weisen die Sensorelemente 1, 2 wenigstens 15, beispielsweise 16 in einem 4x4-Raster angeordnete, besonders bevorzugt wenigstens 20, in dem vorliegenden Ausführungsbeispiel 24 Einzelsensorelemente 1.3 auf. Eine größere Anzahl von Einzelsensorelementen 1.3 kann, unabhängig davon, ob das Einzelsensorelement 1.3 die Kraft in einer oder in drei Raumrichtungen ermittelt, die Auflösung verbessern.
Die Einzelsensorelemente 1.3 sind vorzugsweise in einem Raster oder einer polaren Anordnung angeordnet, beispielsweise wie in den Figuren dargestellt in Reihen und Spalten mit gleichem Rastermaß. Für die Auswertung wesentlich ist insbesondere, die relative Ausrichtung der Einzelsensorelemente 1.3 zueinander zu kennen.
Für jedes Sensorelement 1, 2 kann die auf das Sensorelement 1, 2 wirkende Kraft in drei Raumrichtungen Ex, Fy, Fz derart ermittelt werden, dass eine Projektion der auf die Einzelsensorelemente 1.3 wirkenden Kräfte auf einen virtuellen Punkt 1.2, 2.2 des Sensorelements 1, 2 vorgenommen wird, insbesondere mittels der Auswerte-/Steuereinheit 6. Der virtuelle Punkt 1.2, 2.2 liegt dabei insbesondere auf der Messfläche 1.1, 2.1, beispielsweise zentral. Durch Berücksichtigung der Lage eines einzelnen der Einzelsensorelemente 1.3 relativ zu dem virtuellen Punkt 1.2, 2.2 und Auswertung der Absolutbeträge der auf die auf die Einzelsensorelemente 1.3 wirkenden Einzelkräfte kann die auf das Sensorelement 1, 2 insbesondere an dem virtuellen Punkt 1.2, 2,2 wirkende Kraft in drei Raumrichtungen, also insbesondere die drei Kraf tkomponenten Ex, Fy, Fz, bestimmt werden.
Jedes der beiden zuvor beschriebenen Sensorelemente 1, 2 ermöglicht eine Ermittlung der auf das Sensorelemente 1, 2 und dadurch auch auf den Körper 3 wirkenden Kraft in drei Raumrichtungen .
Bei einem Verfahren zur Ermittlung einer auf den Körper 3, insbesondere einen Manipulator, wirkenden Kraft in mindestens drei Raumrichtungen mit genau einem auf der Oberfläche 3.1 des Körpers 3 angebrachten Sensorelement 1, 2, welches wenigstens drei Einzelsensorelemente 3.1 umfasst, wobei jedes Einzelsensorelement 1.3 zur Ermittlung einer Einzelkraft in einer Richtung ausgebildet ist, oder welches wenigstens ein Einzelsensorelement 1.3 umfasst, welches zur Ermittlung einer Einzelkraft in drei Raumrichtungen ausgebildet ist, und einer Auswerte-/Steuereinheit 6, können dann folgende Schritte durchgeführt werden: Zunächst wird jede auf jedes Einzelsensorelement 1.3 wirkenden Einzelkraft ermittelt. Anschließend wird die auf das Sensorelement 1, 2 wirkenden Kraft in drei Raumrichtungen Ex, Fy, Fz durch Projektion der Einzelkräfte auf einen virtuellen Punkt 1.2, 2.2 des Sensorelements
1, 2 berechnet.
Durch eine kombinierte Auswertung der beiden Sensorelemente 1,
2, welche beispielsweise wie in Figur 1 dargestellt, auf gegenüberliegenden Seiten der Oberfläche 3.1 des Körpers 3 ange- ordnet sein können, kann auf einfache Art und Weise eine Ermittlung der auf den Körper 3 wirkenden Kraft nicht nur in drei, sondern in sechs Raumrichtungen, d. h. die wirkenden Kräfte Ex, Fy, Fz und die wirkenden Drehmomente Mx, My, Mz, ermittelt werden. Die Sensorelemente 1, 2 können in einem Abstand A zueinander angeordnet sein, wobei das Sensorelement 1 den Abstand a zu einem virtuellen Punkt 4 des Körpers 3 und das Sensorelement 2 einen Abstand b zu dem virtuellen Punkt 4 des Körpers 3 aufweisen kann. Vorzugsweise entspricht der Abstand A der Summe der Abstände a und b. Zur Ermittlung der auf den Körper 3 wirkenden Kraft in sechs Raumrichtungen wird eine Projektion der auf die Sensorelemente 1, 2 wirkenden Kräfte auf den virtuellen Punkt 4 des Körpers 3, insbesondere mittels der Auswerte-/Steuereinheit 6 vorgenommen. Da der virtuelle Punkt 4 nicht in der Messfläche 1.1, 2.1 der Sensorelemente 1, 2, sondern beabstandet dazu liegt, können durch Berücksichtigung der Lage der einzelnen der Einzelsensorelemente 1.3 relativ zu dem virtuellen Punkt 4 und Auswertung der Absolutbeträge der auf die auf die Einzelsensorelemente 1.3 wirkenden Einzelkräfte neben den in drei Raumrichtungen wirkenden Kräften Ex, Fy, Fz auch die um die Achsen wirkenden Drehmomente Mx, My, Mz bestimmt werden.
Bei einem Verfahren zur Ermittlung einer auf den Körper 3, insbesondere einen Manipulator, wirkenden Kraft in mindestens drei, vorzugsweise in sechs, Raumrichtungen mit wenigstens zwei auf der Oberfläche 3.1 des Körpers 3 zueinander beabstandet angebrachten Sensorelementen 1, 2 , welche jeweils wenigstens drei Einzelsensorelemente 3.1 umfassen, wobei jedes Einzelsensorelement 1.3 zur Ermittlung einer Einzelkraft in einer Richtung ausgebildet ist, oder welche jeweils wenigstens ein Einzelsensorelement 1.3 umfassen, welches zur Ermittlung einer Einzelkraft in drei Raumrichtungen ausgebildet ist, und einer Auswerte-/Steuereinheit 6, können dann folgende Schritte durchgeführt werden: Zunächst wird für jedes Sensorelement 1, 2 jede auf jedes Einzelsensorelement 1.3 wirkenden Einzelkraft ermittelt. Anschließend wird die auf das Sensorelement 1, 2 wirkenden Kraft in drei Raumrichtungen durch Projektion der Einzelkräfte auf einen virtuellen Punkt 1.2, 2.2 des Sensorelements 1, 2 berechnet. Schließlich werden die auf den Körper 3 wirkenden Kräfte Ex, Fy, Fz, und Drehmomente Mx, My, Mz durch Projektion der auf die Sensorelemente 1, 2 wirkenden Kräfte auf einen virtuellen Punkt 4 des Körpers 3, welcher insbesondere im Raum beabstandet zu den Sensorelementen 1, 2 ist, berechnet.
Eine alternative oder zusätzliche Möglichkeit zur Ermittlung der auf den Körper 3 wirkenden Kraft nicht nur in drei, sondern in sechs Raumrichtungen, wird anhand von Figur 4 erläutert. Das dort dargestellte Sensorelement 1 unterscheidet sich von dem in Figur 1 dargestellten Sensorelement 1 dadurch, dass es eine relativ zum Sensorelement 1 frei gelagerte Abdeckung 1.4 aufweist, welche insbesondere parallel zur Messfläche 1.2 angeordnet ist. Die Abdeckung 1.4 kann beispielsweise an der Oberfläche 1.3 des Körpers fixiert angeordnet sein, relativ zum Sensorelement 1 und insbesondere zur Messfläche 1.2 jedoch bewegbar sein. Ein Benutzer greift somit an der Außenfläche der Abdeckung 1.4 an, die Abdeckung 1.4 ist jedoch mit den Einzelsensorelementen 1.3 verbunden, so dass die auf die Abdeckung 1.4 ausgeübte Kraft über die Rückseite der Abdeckung 1.4 auf die Einzelsensorelemente 1.3 übertragen wird. Der virtuelle Punkt 1.2 liegt beabstandet zur Außenfläche der Abdeckung 1.4 in der Messfläche 1.2, wodurch eine Ermittlung nicht nur der drei Kraf tkomponenten Ex, Fy, Fz in drei Raumrichtungen, sondern zusätzlich die wirkenden Drehmomente Mx, My, Mz ermöglicht wird. Bei einem Verfahren zur Ermittlung einer auf den Körper 3, insbesondere einen Manipulator, wirkenden Kraft in mindestens drei Raumrichtungen mit einem auf der Oberfläche 3.1 des Körpers 3 angebrachten Sensorelement 1 insbesondere gemäß Figur 4, welches wenigstens ein Einzelsensorelement 1.3, welches zur Ermittlung einer Einzelkraft in drei Raumrichtungen ausgebildet ist, oder wenigstens drei Einzelsensorelemente, welche zur Ermittlung einer Einzelkraft in einer Richtungen ausgebildet ist, sowie eine relativ zum Sensorelement 1 frei gelagerte Abdeckung 1.4 umfasst, und einer Auswerte-/Steuereinheit 6, können dann folgende Schritte durchgeführt werden: Zunächst wird jede auf jedes Einzelsensorelement 1.3 wirkenden Einzelkraft ermittelt. Anschließend wird die auf das Sensorelement 1, 2 wirkenden Kraft in drei Raumrichtungen durch Projektion der Einzelkräfte auf einen virtuellen Punkt 1.2 des Sensorelements 1, 2 berechnet, wobei der Abstand zwischen der Abdeckung 1.4 und der Messfläche 1.1 berücksichtigt wird.
Figur 1 zeigt die Sensorelemente 1, 2 als planare Sensorelemente 1, 2, welche zur Vereinfachung der Darstellung in nicht realistischer Weise tangential an der gewölbten Oberfläche 3.1 des Körpers 3 dargestellt sind. Bevorzugt passen sich die Sensorelemente 1, 2 der Oberfläche 3.1 des Körpers 3 an. Besonders vorteilhaft können die Sensorelemente 1, 2 aus einem flexiblen Material gefertigt sein. Vorteilhafterweise sind die Sensorelemente 1, 2 nach Art einer künstlichen, taktilen Haut auf den Körper 3 aufbringbar. Dabei kann eine Vielzahl von Sensorelementen 1, 2 auf der Oberfläche 3.1 des Körpers 3 angeordnet sein und insbesondere einen Großteil der Oberfläche 3.1, vorzugsweise die gesamte Oberfläche 3.1, des Körpers 3 bedecken . Zur Ansteuerung der Bewegung des Körpers 3 wird vorzugsweise basierend auf der auf den Körper einwirkenden Kraft eine Stellgröße ermittelt, welche die Antriebseinheit 7 in eine entsprechende Bewegung des Körpers 3 in Richtung der einwirkenden Kraft umsetzt. Vorzugsweise ist dazu ein Regler 5 insbesondere in der Auswerte-/Steuereinheit 6 vorgesehen, welcher in Figur 2 schematisch dargestellt ist. Der Regler 5 ist dazu vorgesehen, auf Basis der Änderung des Kräftegleichgewichts des Körpers 3 eine Folgebewegung des Körpers 3 in Richtung des Kräfteungleichgewichts durchzuführen. Der Regler 5 kann dazu eine Regelstrecke 5.3 und eine Regeleinrichtung 5.4 umfassen, wobei in die Regeleinrichtung 5.4 als Eingangswert eine Regeldifferenz 5.8 eingeht, die sich aus einem Istwert 5.1 und einem Sollwert 5.6 in einem Vergleichsglied 5.7 ergibt. Der Istwert 5.1 entspricht insbesondere der auf den Körper 3 wirkenden Kraft, welche mithilfe der Sensorelemente 1, 2 ermittelt wurde. Der Sollwert 5.6 kann beispielsweise durch das Kräftegleichgewicht definiert sein. Die Regelstrecke 5.3 liefert als Resultat eine Regelgröße 5.2, welche die Stellgröße für die Antriebseinheit 7 vorgeben kann. In der Regelstrecke 5.3 können Störgrößen 5.5 berücksichtigt werden. Die anschließend durchgeführte Bewegung des Körpers kann beispielsweise eine lineare Bewegung oder eine Drehbewegung sein. Der Mittelpunkt der Bewegung kann durch eine kinematische Transformation an beliebige Punkte des Körpers 3 gelegt werden, beispielsweise an den virtuellen Punkt 4, aber auch an andere Punkte. Dabei ermöglichen die Auswerte-/Steuereinheit 6 und die Antriebseinheit 7 das Feststellen einer oder mehrerer Raumrichtungen, so dass gezielte Bewegungen in gewünschte Raumrichtungen durchgeführt werden können.
Im Anschluss an jedes der beschriebenen Verfahren zur Ermittlung der auf den Körper 3 wirkenden Kraft können somit bei- spielsweise anschließend die auf den Körper wirkenden Kräfte als Istwerte 5.1 in den Regler 5 eingebracht werden, die Istwerte 5.1 mit dem Sollwert 5.6 verglichen werden und eine Stellgröße für eine Bewegungssteuerung zur Erreichung des Sollwerts 5.6 ermittelt werden, um ein Verfahren zur Ansteuerung der Bewegung des Körpers 3 bereitzustellen. Bei diesem Verfahren zur Ansteuerung der Bewegung des Körpers 3 können in dem Regler 5 auch Störgrößen 5.5, insbesondere in der Regelstrecke 5.3, berücksichtigt werden.
Die Daten- und Signalübertragung zwischen sämtlichen Komponenten kann kabelgebunden oder drahtlos erfolgen.
Bei jeder der beschriebenen Berechnungen können zur Auswertung sämtliche Einzelsensorelemente 1.3 herangezogen werden. Es besteht auch die Möglichkeit, die Einzelsensorelemente 1.3 in zwei Gruppen von Einzelsensorelementen 1.3', 1.3' ' aufzuteilen, wobei die Gruppe der Einzelsensorelemente 1.3', welche in Figur 1 zur Illustration ohne Schraffur dargestellt ist, unabhängig von der Gruppe der Einzelsensorelemente 1.3' ', welche in Figur 1 zur Illustration mit Schraffur dargestellt ist, ausgewertet werden kann, beispielsweise, um eine redundante Auswertung zu ermöglichen. Die Einzelsensorelemente 1.3', 1.3' ' in jeder Gruppe sind vorzugsweise jeweils in einem Raster oder einer polaren Anordnung angeordnet, wobei insbesondere die Raster oder die polaren Anordnungen ineinandergreifend angeordnet sind, beispielsweise nach Art eines Schachbretts (vgl. Figur 1 oder Figur 4) . Bei mehreren Sensorelementen 1, 2 ist auch eine separierte und/oder unabhängige Auswertung jedes Sensorelements 1, 2 möglich, um einen zusätzlichen Plausibilitätscheck durchführen zu können und beispielsweise zu prüfen, ob an jedem der Sensorelemente 1, 2 eine Kraft anliegt und/oder um eine weitere Redundanz zu ermöglichen. Bei j edem der beschriebenen Verfahren zur Ermittlung einer auf den Körper 3 wirkenden Kraft kann somit die Ermittlung der auf den Körper wirkenden Kraft unabhängig voneinander mittels zweier Gruppen von Einzelsensorelementen 1 . 3 ' . 1 . 3 ' ' erfolgen .
Durch geeignete Auswertung der auf die Sensorelemente 1 , 2 und insbesondere die auf die Einzelsensoren 1 . 3 wirkenden Einzelkräfte können weitere sicherheitsrelevante Funktionen realisiert werden . Typische sicherheitsrelevante Freigabeschalter für Bewegungen des Körpers 3 wie beispielsweise ein Totmannschalter oder ein Bestätigungsschalter können drei Schaltstufen aufweisen, nämlich eine Schaltstufe S l , in welcher der Schalter nicht betätigt ist , eine Schaltstufe S2 , in welcher eine Freigabe für eine Bewegung des Körpers 3 erfolgt , und eine Schaltstufe S3 , in welcher ein Not-Halt erfolgt . Dazu können ein minimaler Kraftwert Gl und ein maximaler Kraftwert G2 als untere und obere Schaltschwelle definiert werden, wobei die Schaltstufe S l bei einer Kraft unterhalb des minimalen Kraftwerts Gl , die Schaltstufe S2 bei einer Kraft zwischen dem minimalen Kraftwert Gl und dem maximalen Kraftwert G2 und die Schaltstufe S3 bei einer Kraft oberhalb des maximalen Kraftwerts G2 vorliegt (vgl . Figur 3 , in welcher ein Beispiel für den Betrag F der auf die Sensorelemente 1 , 2 wirkenden Kräfte in Abhängigkeit von der Zeit t aufgetragen sind) . Beispielsweise kann eine Freigabe der Bewegung des Körpers 3 erfolgen, wenn für eines der Sensorelemente 1 , 2 der Betrag F der auf das Sensorelement 1 , 2 wirkenden Kraft im Bereich der Schaltstufe S2 liegt . Die Sicherheits funktion wird verbessert , wenn, wie in Figur 3 dargestellt , eine Freigabe der Bewegung des Körpers 3 dann erfolgt , wenn für beide Sensorelemente 1 , 2 der Betrag F der auf das Sensorelement 1 , 2 wirkenden Kraft im Bereich der Schaltstufe S2 liegt . Bei einem Beispiel für ein Verfahren zur Ansteuerung des Körpers 3 kann dann zunächst die auf den Körper 3 wirkende Kraft mithil fe der Sensorelemente 1 , 2 ermittelt werden, anschließend die ermittelte Kraft , insbesondere der Betrag F der mittelten Kraft , mit einem vorgegebenen minimalen Kraftwert Gl und/oder einem maximalen Kraftwert G2 verglichen werden und eine Freigabe der Bewegung des Körpers 3 erfolgen, sofern die ermittelte Kraft oder der Betrag F der ermittelten Kraft größer als der minimale Kraftwert Gl und/oder kleiner als der maximale Kraftwert G2 ist .
In der Auswerte-/Steuereinheit 6 können in einer Aus führungsform der Erfindung Muster der auf den Körper 3 wirkenden Kraft für Ansteuerbefehle hinterlegt sein, wobei die Muster Kraftprofile in Abhängigkeit von der Zeit t darstellen . Die auf den Körper 3 wirkende Kraft in Abhängigkeit von der Zeit t , insbesondere der Betrag F der auf den Körper 3 wirkenden Kraft in Abhängigkeit von der Zeit t , kann mit den hinterlegten Mustern verglichen werden, um derartige Muster zu erkennen und darauf folgend den entsprechenden Ansteuerbefehl umzusetzen . Figur 5 zeigt beispielshaf t ein Kraftprofil , bei welchem zweimal auf das Sensorelement 1 getippt wird . Die Kraftmaxima ergeben sich zu den Zeitpunkten tl und t2 . I st beispielsweise der zeitliche Abstand t2 - tl kleiner als eine in dem hinterlegten Muster vorgegebene Zeitdi f ferenz und überschreiten die Kraftmaxima einen in dem hinterlegten Muster vorgegeben minimalen Grenzwert Gl , kann das Muster erkannt werden und den entsprechenden Ansteuerbefehl , der mit dem Muster verknüpft und entsprechend in der Auswerte-/Steuereinheit hinterlegt ist , aus führen, beispielsweise kann die aktuelle Stellung des Körpers 3 , beispielsweise eines Arms eines Manipulators , gespeichert werden oder eine Bedienung von am Körper 3 befestigten Zubehörs wie beispielsweise eines Eingabefelds freigegeben werden . Bei einem Verfahren zur Ansteuerung des Körpers 3 , insbesondere eines Manipulators , kann daher nach der Ermittlung der auf den Körper 3 wirkenden Kraft , insbesondere des Betrags F der auf den Körper 3 wirkenden Kraft , in Abhängigkeit von der Zeit t eine Erkennung von Mustern der auf den Körper 3 wirkenden
Kraft für Eingabe- und/oder Ansteuerbefehle erfolgen .
Bezugszeichenliste
1 Sensorelement
1.1 Messfläche
1.2 virtueller Punkt
1.3 Einzelsensorelement
1.3' Einzelsensorelement
1.3' 'Einzelsensorelement
1.4 Abdeckung
2 Sensorelement
1.1 Messfläche
2.1 virtueller Punkt
3 Körper
3.1 Oberfläche
4 virtueller Punkt
5 Regler
5.1 Istwert
5.2 Regelgröße
5.3 Regelstrecke
5.4 Regeleinrichtung
5.5 Störgröße
5.6 Sollwert
5.7 Vergleichsglied
5.8 Regeldifferenz
6 Auswerte-/Steuereinheit
7 Antriebseinheit
10 Vorrichtung
A Abstand a Abstand b Abstand
F Kraft
Ex Kraft
Fy Kraft Fz Kraft
Mx Drehmomemt
My Drehmoment
Mz Drehmoment t Zeit
51 Schaltstufe
52 Schaltstufe
53 Schaltstufe
Gl minimaler Kraftwert G2 maximaler Kraftwert

Claims

24 Patentansprüche
1. Vorrichtung zur Ermittlung einer auf einen Körper (3) , insbesondere einen Manipulator, wirkenden Kraft in wenigstens drei Raumrichtungen (Fx, Fy, Fz, Mx, My, Mz) mit -wenigstens einem Sensorelement (1, 2) zur Anbringung auf der Oberfläche (3.1) des Körpers (3) , welches wenigstens drei Einzelsensorelemente (1.3) umfasst, wobei jedes Einzelsensorelement (1.3) zur Ermittlung einer Einzelkraft in einer Richtung ausgebildet ist, oder welches wenigstens ein Einzelsensorelement (1.3) umfasst, welches zur Ermittlung einer Einzelkraft in drei Raumrichtungen ausgebildet ist,
- und einer Auswerte-/Steuereinheit (6) , welche die von jedem Einzelsensorelement (1.3) ermittelte Einzelkraft erfasst und welche dazu ausgebildet ist, die auf das Sensorelement (1, 2) wirkende Kraft in wenigstens drei Raumrichtungen (Fx, Fy, Fz, Mx, My, Mz) durch Projektion der Einzelkräfte auf einen virtuellen Punkt (1.2, 2.2) des Sensorelements (1, 2) zu berechnen.
2. Vorrichtung nach Anspruch 1, d a d u r c h g e k e n n z e i c h n e t, dass jedes Sensorelement (1, 2) mehrere, vorzugsweise wenigstens 15, besonders bevorzugt wenigstens 20, Einzelsensorelemente (1.3) umfasst.
3. Vorrichtung nach einem der vorhergehenden Ansprüche, d a d u r c h g e k e n n z e i c h n e t, dass die Einzelsensorelemente (1.3) in einem Raster oder einer polaren Anordnung angeordnet sind. Vorrichtung nach einem der vorhergehenden Ansprüche, d a d u r c h g e k e n n z e i c h n e t, dass die Einzelsensorelemente (1.3) jedes Sensorelements (1, 2) wenigstens zwei Gruppen von Einzelsensorelementen (1.3', 1.3' ') aufweist, welche unabhängig voneinander auswertbar sind . Vorrichtung nach einem der vorhergehenden Ansprüche, d a d u r c h g e k e n n z e i c h n e t, dass die Einzelsensorelemente (1.3', 1.3' ') jeder Gruppe in jeweils einem Raster oder einer polaren Anordnung angeordnet sind, wobei vorzugsweise die Raster oder die polaren Anordnungen ineinandergreifend angeordnet sind und beispielsweise nach Art eines Schachbretts ausgestaltet sind . Vorrichtung nach einem der vorhergehenden Ansprüche, d a d u r c h g e k e n n z e i c h n e t, dass die Vorrichtung wenigstens zwei Sensorelemente (1, 2) umfasst, welche vorzugsweise in einem Abstand (A) zueinander, besonders bevorzugt auf zwei gegenüberliegenden Seiten der Oberfläche (3.1) des Körpers (3) , angeordnet sind . Vorrichtung nach Anspruch 6, d a d u r c h g e k e n n z e i c h n e t, dass die Sensorelemente (1, 2) unabhängig voneinander auswertbar sind . Vorrichtung nach einem der vorhergehenden Ansprüche, d a d u r c h g e k e n n z e i c h n e t, dass das Sensorelement (1) eine relativ zum Sensorelement (1) frei gelagerte Abdeckung (1.4) aufweist. Vorrichtung nach einem der vorhergehenden Ansprüche, d a d u r c h g e k e n n z e i c h n e t, dass das Sensorelement (1, 2) aus einem flexiblen Material gefertigt ist, welches insbesondere nach Art einer Haut auf den Körper (3) aufbringbar ist. . Vorrichtung nach einem der vorhergehenden Ansprüche, d a d u r c h g e k e n n z e i c h n e t, dass die Auswerte-/Steuereinheit (6) einen Regler (5) umfasst, in welchen die auf den Körper (3) wirkende Kraft als Istwert
(5.1) einbringbar ist. . Körper (3) , insbesondere Manipulator, vorzugsweise Industrieroboter oder Cobot, mit einer Vorrichtung (10) nach einem der vorhergehenden Ansprüche, wobei das wenigstens eine Sensorelement (1, 2) , vorzugsweise die wenigstens zwei Sensorelemente (1, 2) , auf der Oberfläche
(3.1) des Körpers (3) angeordnet sind. . Körper nach Anspruch 11, d a d u r c h g e k e n n z e i c h n e t, dass eine Vielzahl von Sensorelementen (1, 2) auf der Oberfläche
(3.1) des Körpers (3) angeordnet ist und diese insbesondere einen Großteil der Oberfläche (3.1) , vorzugsweise die gesamte Oberfläche (3.1) , des Körpers (3) bedecken, wobei vorzugsweise die Sensorelemente (1, 2) aus einem flexiblen Material gefertigt sind, welches insbesondere nach Art einer Haut auf den Körper (3) aufbringbar sind. . Verfahren zur Ermittlung einer auf einen Körper (3) , insbesondere einen Manipulator, wirkenden Kraft in wenigstens drei Raumrichtungen (Ex, Fy, Fz, Mx, My, Mz) mit 27 wenigstens einem auf der Oberfläche (3.1) des Körpers (3) angebrachten Sensorelement (1, 2) , welches wenigstens drei Einzelsensorelemente (1.3) umfasst, wobei jedes Einzelsensorelement (1.3) zur Ermittlung einer Einzelkraft in einer Richtung ausgebildet ist, oder welches wenigstens ein Einzelsensorelement (1.3) umfasst, welches zur Ermittlung einer Einzelkraft in drei Raumrichtungen ausgebildet ist,
, und einer Auswerte-/Steuereinheit (6) , mit den Schritten :
- Ermittlung jeder auf jedes Einzelsensorelement (1.3) wirkenden Einzelkraft,
- Berechnung der auf das Sensorelement (1, 2) wirkenden Kraft in wenigstens drei Raumrichtungen (Ex, Fy, Fz, Mx, My, Mz) durch Projektion der Einzelkräfte auf einen virtuellen Punkt (1.2, 2.2) des Sensorelements (1, 2) . . Verfahren zur Ermittlung einer auf einen Körper wirkenden Kraft nach Anspruch 13, d a d u r c h g e k e n n z e i c h n e t, dass wenigstens zwei Sensorelemente (1, 2) auf der Oberfläche (3.1) des Körpers (3) in einem Abstand (A) zueinander angeordnet sind, wobei die folgenden Schritte durchgeführt werden :
- Ermittlung jeder auf jedes Einzelsensorelement (1.3) wirkende Einzelkraft für jedes Sensorelement (1, 2) ,
- Berechnung der auf das Sensorelement (1, 2) wirkenden Kraft in wenigstens drei Raumrichtungen (Ex, Fy, Fz, Mx, My, Mz) durch Projektion der Einzelkräfte auf einen virtuellen Punkt (1.2, 2.2) des Sensorelements (1, 2) für jedes Sensorelement (1, 2) ,
- Berechnung der auf den Körper (3) wirkenden Kräfte (Ex, Fy, Fz) und Drehmomente (Mx, My, Mz) durch Projektion der 28 auf die Sensorelemente (1, 2) wirkenden Kräfte auf einen virtuellen Punkt (4) des Körpers (3) , welcher insbesondere im Raum beabstandet zu den Sensorelementen (1, 2) ist. . Verfahren nach einem der Ansprüche 13 bis 14, d a d u r c h g e k e n n z e i c h n e t, dass die Ermittlung der auf den Körper (3) wirkenden Kraft unabhängig voneinander mittels zweier Gruppen von Einzelsensorelementen (1.3', 1.3' ') erfolgt. . Verfahren zur Ansteuerung der Bewegung eines Körpers
(3) , insbesondere eines Manipulators, mit den Schritten:
- Ermittlung der auf den Körper (3) wirkenden Kraft mit einem Verfahren nach einem der Ansprüche 13 bis 15,
- Einbringen der auf den Körper (3) wirkenden Kraft als
Istwert (5.1) in einen Regler (5) ,
- Vergleich des Istwerts (5.1) mit einem Sollwert (5.6) des Reglers ( 5 ) ,
- Ermittlung einer Stellgröße (5.2) für eine Bewegungssteuerung zur Erreichung des Sollwerts (5.6) . . Verfahren zur Ansteuerung der Bewegung eines Körpers nach Anspruch 16, d a d u r c h g e k e n n z e i c h n e t, dass in dem Regler (5) Störgrößen (5.5) berücksichtigt werden. . Verfahren zur Ansteuerung eines Körpers (3) , insbesondere eines Manipulators, mit den Schritten:
- Ermittlung der auf den Körper (3) wirkenden Kraft mit einem Verfahren nach einem der Ansprüche 13 bis 15,
- Vergleich der ermittelten Kraft (F) mit einem vorgegebenen minimalen Kraftwert (Gl) und/oder einem maximalen Kraftwert (G2 ) , 29
- Freigabe der Bewegung des Körpers (3) , sofern die ermittelte Kraft (F) größer als der minimale Kraftwert (Gl) und/oder kleiner als der maximale Kraftwert (G2) ist. 19. Verfahren zur Ansteuerung eines Körpers (3) , insbesondere eines Manipulators, mit den Schritten:
- Ermittlung der auf den Körper (3) wirkenden Kraft mit einem Verfahren nach einem der Ansprüche 13 bis 15 in Abhängigkeit von der Zeit, -Erkennen von Mustern der auf den Körper (3) wirkenden
Kraft für Eingabe- und/oder Ansteuerbefehle.
EP21777728.3A 2020-09-30 2021-09-15 Vorrichtung und verfahren zur ermittlung einer auf einen körper wirkenden kraft in wenigstens drei raumrichtungen und verfahren zur ansteuerung der bewegung eines körpers Pending EP4222465A1 (de)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
DE102020125583.7A DE102020125583A1 (de) 2020-09-30 2020-09-30 Vorrichtung und Verfahren zur Ermittlung einer auf einen Körper wirkenden Kraft in wenigstens drei Raumrichtungen und Verfahren zur Ansteuerung der Bewegung eines Körpers
PCT/EP2021/075307 WO2022069224A1 (de) 2020-09-30 2021-09-15 Vorrichtung und verfahren zur ermittlung einer auf einen körper wirkenden kraft in wenigstens drei raumrichtungen und verfahren zur ansteuerung der bewegung eines körpers

Publications (1)

Publication Number Publication Date
EP4222465A1 true EP4222465A1 (de) 2023-08-09

Family

ID=77914353

Family Applications (1)

Application Number Title Priority Date Filing Date
EP21777728.3A Pending EP4222465A1 (de) 2020-09-30 2021-09-15 Vorrichtung und verfahren zur ermittlung einer auf einen körper wirkenden kraft in wenigstens drei raumrichtungen und verfahren zur ansteuerung der bewegung eines körpers

Country Status (6)

Country Link
US (1) US20230366761A1 (de)
EP (1) EP4222465A1 (de)
JP (1) JP2023543845A (de)
DE (1) DE102020125583A1 (de)
TW (1) TWI819382B (de)
WO (1) WO2022069224A1 (de)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11530052B1 (en) 2020-02-17 2022-12-20 Amazon Technologies, Inc. Systems and methods for automated ground handling of aerial vehicles
US11597092B1 (en) 2020-03-26 2023-03-07 Amazon Technologies, Ine. End-of-arm tool with a load cell
US11534924B1 (en) 2020-07-21 2022-12-27 Amazon Technologies, Inc. Systems and methods for generating models for automated handling of vehicles
US11534915B1 (en) 2020-08-05 2022-12-27 Amazon Technologies, Inc. Determining vehicle integrity based on observed behavior during predetermined manipulations

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006275979A (ja) * 2005-03-30 2006-10-12 National Institute Of Information & Communication Technology センサ素子、センサ装置、対象物移動制御装置、対象物判別装置
JP5003336B2 (ja) 2007-07-31 2012-08-15 ソニー株式会社 検出装置、ロボット装置、および入力装置
DE102014114234B4 (de) 2014-09-30 2020-06-25 Kastanienbaum GmbH Verfahren und Vorrichtung zur Steuerung/Regelung eines Roboter-Manipulators
JP2016205942A (ja) 2015-04-20 2016-12-08 学校法人早稲田大学 多軸力センサ
JP6571618B2 (ja) 2016-09-08 2019-09-04 ファナック株式会社 人間協調型ロボット
JP7053410B2 (ja) 2018-08-30 2022-04-12 トヨタ自動車株式会社 センサユニット、センサシステム、ロボットハンド、ロボットアーム、サーバ装置、演算方法、およびプログラム

Also Published As

Publication number Publication date
TWI819382B (zh) 2023-10-21
TW202218840A (zh) 2022-05-16
US20230366761A1 (en) 2023-11-16
DE102020125583A1 (de) 2022-03-31
WO2022069224A1 (de) 2022-04-07
JP2023543845A (ja) 2023-10-18

Similar Documents

Publication Publication Date Title
EP4222465A1 (de) Vorrichtung und verfahren zur ermittlung einer auf einen körper wirkenden kraft in wenigstens drei raumrichtungen und verfahren zur ansteuerung der bewegung eines körpers
EP0108348B1 (de) Fernsteuereinrichtung zum Eingeben und/oder zum Programmieren von Bewegungen, Kräften und Drehmomenten eines Roboters, eines Manipulators, und eines graphischen Displays mit Hilfe eines sechsdimensionalen Kraft-Momenten-Sensors
DE102018116053B4 (de) Robotersystem und Roboterlernverfahren
DE102015004483B4 (de) Robotersteuerung und Robotersystem zum Bewegen eines Roboters als Reaktion auf eine Kraft
DE19720049B4 (de) Verfahren zur Steuerung eines motorischen Koordinatenmeßgerätes sowie Koordinatenmeßgerät zur Durchführung des Verfahrens
DE102016008908B4 (de) Industrierobotersystem und Steuerverfahren dafür
EP2546711B1 (de) Verfahren zum Programmieren eines Roboters
DE102013019869B4 (de) Roboterarm mit Eingabemodul
EP2851162B1 (de) Verfahren zum manuell geführten Verstellen der Pose eines Manipulatorarms eines Industrieroboters und zugehöriger Industrieroboter
DE102007050232B4 (de) Handhabungsroboter und Verfahren zur Steuerung eines Handhabungsroboters
DE102015004484A1 (de) Robotersteuerung und Robotersystem zum Bewegen eines Roboters in Erwiderung einer Kraft
DE68922684T2 (de) Profilsteuersystem für eine gegebene gekrümmte Fläche.
DE102014004919B4 (de) Verfahren und Mittel zum Handhaben eines Objekts
DE102012212754A1 (de) Verfahren zum Betreiben eines Sensorsystems sowie Sensorsystem
DE102006061752A1 (de) Roboter und Verfahren zum Programmieren eines Roboters
DE3211992A1 (de) Verfahren und vorrichtung zum programmieren eines roboters, insbesondere farbspritzroboters
DE102017108492B4 (de) Steuervorrichtung eines Roboters, die ein Betriebsprogramm, in dem der Zustand einer zusätzlichen Achse enthalten ist, anzeigt
EP3328595A2 (de) Verfahren und system zum steuern eines roboters
DE102016212958A1 (de) Redundanzauflösung für einen redundanten Manipulator
DE102020206568B4 (de) Programmiersystem zum handgeführten Programmieren einer Bewegung eines Industrieroboters, Industrieroboter mit einem solchen Programmiersystem und Verfahren zum handgeführten Programmieren einer Bewegung eines Industrieroboters
DE102017204211B4 (de) Robotersteuerung und Robotersteuerungsverfahren
DE102020102160B3 (de) Verfahren zum Erzeugen eines Eingabebefehls für einen Roboterarm und Roboterarm
EP3132331B1 (de) Haptisches system und verfahren zum betreiben
DE102020103853B4 (de) Graphisch unterstützte Anpassung von Roboter-Steuerprogrammen
DE3902247A1 (de) Vorrichtung zur steuerung der bewegungsablaeufe von handlingsystemen oder robotern

Legal Events

Date Code Title Description
STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: UNKNOWN

STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE

PUAI Public reference made under article 153(3) epc to a published international application that has entered the european phase

Free format text: ORIGINAL CODE: 0009012

STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE

17P Request for examination filed

Effective date: 20230403

AK Designated contracting states

Kind code of ref document: A1

Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR

DAV Request for validation of the european patent (deleted)
DAX Request for extension of the european patent (deleted)