WO2018115134A2 - Sichere ermittlung von achsstellungen und/oder -geschwindigkeiten eines roboters - Google Patents

Sichere ermittlung von achsstellungen und/oder -geschwindigkeiten eines roboters Download PDF

Info

Publication number
WO2018115134A2
WO2018115134A2 PCT/EP2017/083837 EP2017083837W WO2018115134A2 WO 2018115134 A2 WO2018115134 A2 WO 2018115134A2 EP 2017083837 W EP2017083837 W EP 2017083837W WO 2018115134 A2 WO2018115134 A2 WO 2018115134A2
Authority
WO
WIPO (PCT)
Prior art keywords
parameter
axis
robot
speed
determined
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.)
Ceased
Application number
PCT/EP2017/083837
Other languages
English (en)
French (fr)
Other versions
WO2018115134A3 (de
Inventor
Stefan Roth
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.)
KUKA Deutschland GmbH
Original Assignee
KUKA Roboter 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 KUKA Roboter GmbH filed Critical KUKA Roboter GmbH
Publication of WO2018115134A2 publication Critical patent/WO2018115134A2/de
Publication of WO2018115134A3 publication Critical patent/WO2018115134A3/de
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Program-controlled manipulators
    • B25J9/16—Program controls
    • B25J9/1674—Program controls characterised by safety, monitoring, diagnostic
    • 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
    • G05B19/00—Program-control systems
    • G05B19/02—Program-control systems electric
    • G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form
    • G05B19/406—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by monitoring or safety
    • 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/37—Measurements
    • G05B2219/37297—Two measurements, on driving motor and on slide or on both sides of motor
    • 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/37—Measurements
    • G05B2219/37301—Two measurements, speed with tachometer and speed with encoder
    • 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/37—Measurements
    • G05B2219/37304—Combined position measurement, encoder and separate laser, two different sensors
    • 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/37—Measurements
    • G05B2219/37547—Ignore position information from detector during invalid intervals
    • 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/42—Servomotor, servo controller kind till VSS
    • G05B2219/42318—Using two, more, redundant measurements or scales to detect bad function

Definitions

  • the present invention relates to a method and a system for safe
  • Axis positions and / or speeds of robots must be reliably determined for various purposes, for example, for safety monitoring and / or (safe) control of the robot, in the present case for a more compact representation also a control is generally referred to as a controller.
  • DE 10 2013 005 941 A1 relates to energy recovery in electric motors and teaches to measure their rotational positions by means of resolvers or alternatively to calculate the rotation angle and the rotational speed on the basis of the alternating current and the voltage fed to the electric motor.
  • the object of the present invention is to provide a reliable determination of at least one position of at least one axis of a robot.
  • Claims 8, 10 provide a system or computer program product
  • a method for safely determining one or more positions and / or speeds of one or more axes of a robot comprises the steps of: (each)
  • Speed of the (respective) axis depends, in particular on the basis or as a function of the position or speed, by means of a sensor;
  • Electric motor is driven, which drives the axis or is set up for this purpose or is used, in particular based on or in dependence on the
  • (Rotor) position and / or speed of this electric motor depends, in particular on the basis or as a function of the (rotor) position or
  • the at least one axis of the robot is preferably mechanically coupled slip-free with an associated axis of the electric motor (electric motor axis), which drives the robot axis.
  • slip may also occur, in particular if a transmission is arranged between the electric motor axis and the robot axis.
  • the robot axis and the associated electric motor axis can be aligned with each other or integrally formed.
  • a system in particular hardware and / or software, in particular program technology, is set up to carry out a method described here and / or has a position for determining one or more positions and / or speeds of one or more axes Robot (robot axis) on:
  • robot axis depends, in particular on the basis of or depending on the position or
  • a second parameter which depends on a (rotor) position and / or speed of this electric motor, in particular on the basis of or as a function of the (rotor) position or speed;
  • Parameter used as safely determined parameters in particular issued and / or a safety monitoring and / or control, in particular so
  • Control based on the robot is, in a second operating mode in which the first parameter is not used as a safely determined parameter, in particular issued and / or safety monitoring and / or control, in particular control, the robot is based, if a deviation between this first and second parameters exceeds a predetermined limit value, in particular for switching over from the first to the second operating mode, if a deviation between at least one of the first and second parameters exceeds a limit value, in particular axis-specific or axis-specifically predetermined. This is based on the fact that (rotary) movements of a rotor of a
  • Electric motors in the stator windings induce reverse voltages, which can be measured back, as for example, for sensorless control, in particular by means of block commutation, and / or to a vector control per se is known. Therefore, the second parameter may be preferred only by the
  • the evaluability or the confidence of the second parameter can be dependent on the speed or speed of the electric motor, in particular since the determination of the with the rotor position
  • correlating second parameter may have a signal-to-noise ratio, which improves with increasing speed.
  • Minimum speed exceeds.
  • the robot ie for speeds of the electric motor below the minimum speed, the robot preferably moves so slowly or stands still that there is no danger from the movement of the robot.
  • the present invention is based on the idea of using this induced countervoltage (s), which depends on the position of the rotor relative to the stator winding (s), in order in addition to or via the sensor determined first parameter to determine a further, second parameter, which also depends on the position or the temporally successive positions of the rotor and thus the axis, and to check on the basis of the reliability of the sensor or the first parameter.
  • s induced countervoltage
  • second parameter which also depends on the position or the temporally successive positions of the rotor and thus the axis
  • the first parameter comprises or indicates, in particular, the current, position and / or speed of the (respective) axis determined by means of the sensor.
  • the second parameter (in each case) comprises a position of the electric motor, in particular of its rotor or its output shaft, determined on the basis of or in dependence on the induced countervoltage (s) / or the axis coupled thereto of the robot and / or their temporal change or speed, or indicates this.
  • the method comprises the steps: Determining a temporal change of the (respective) first parameter;
  • a temporal change in the sense of the invention may include, in addition to the time derivation, also (normalized) cross-correlations between the temporal course of the first and second parameters.
  • Phase shift (s) determined or calculated.
  • a phase shift (s) determined or calculated.
  • a plausible range may then be defined as a range with a correlation greater than a predetermined correlation coefficient, for example as a range with a correlation coefficient greater than 0.6, preferably greater than 0.8, more preferably greater than 0.9, the correlation coefficient being, for example for a single time shift (also a shift of 0) can be determined or as an average of several time shifts or as a maximum value for all possible determinable by the correlation function temporal
  • Correlation functions are also used over the time disturbed or not ideal determined first and second parameters for plausibility decision.
  • the system includes methods:
  • the (respective) plausible range is, in particular, specified in an embodiment based on dynamics of the robot and / or the (respective) sensor.
  • the first parameter or the axis position can (still) be safely (still) he) are determined.
  • this makes it possible to detect the first parameter non-redundantly and nevertheless to reliably monitor and / or control the robot, in particular thus to regulate, in particular with a Safety Integrity Level (SIL) "3” or “C”, in particular SIL "4" or “D” according to IEC 61508.
  • SIL Safety Integrity Level
  • this can advantageously be an information, in particular
  • a safety monitoring and / or control, in particular a control, of the robot can be improved, in particular its cycle time.
  • a message is issued in the second mode of operation.
  • the system includes means for issuing a message in the second mode of operation.
  • a safety monitoring and / or control of the robot can initiate appropriate (counter) measures, in particular, shut down at least the respective axis (s), in particular all the axes or the robot.
  • the system has means for stopping at least the (respective) axis (s), in particular all axes or the robot, in the second operating mode.
  • the senor in each case at least) one, in particular touching or non-contact measuring, angle and / or (each at least) one, in particular touching or non-contact measuring,
  • Speedometer in particular resolver and / or tachogenerator and / or incremental encoder on, he may in particular be such. Particularly in the case of such sensors, redundant evaluation can advantageously be saved and / or signal transmission and / or processing can be reduced.
  • the second parameter is based on or in dependence on a measured voltage in at least one winding, in particular
  • Stator winding the electric motor, in a development based on or in
  • the system comprises means for determining the second parameter on the basis of or as a function of a measured voltage in at least one winding, in particular stator winding of the electric motor, in a development on the basis of or measured voltages in at least two , in particular three, windings, in particular stator winding, of the electric motor.
  • the second parameter can be determined in one embodiment, in particular metrologically, simply and / or precisely, by means of measurement in at least two, in particular three, windings in one embodiment advantageous, in particular reliable (he) and / or exactly (he).
  • the second parameter is based on or in dependence on a control variable, in particular thus control variable, in particular a field and / or a Kirutierwinkels and / or a
  • Pulse width modulation ratio for at least one winding, in particular stator winding of the electric motor, in a development based on or in Dependence on control variables, in particular thus control variables, in particular pulse width modulation ratios, for at least two, in particular three, windings, in particular stator windings, of the electric motor, in particular based on or dependent on control variables, in particular control variables, for or into or from a converter for energizing the winding (s) and / or for or in or from a vector control determined.
  • the system comprises means for determining the second parameter on the basis of or as a function of a control variable, in particular thus controlled variable, in particular a field and / or a commutation angle and / or a
  • Pulse width modulation ratio for at least one winding, in particular stator winding of the electric motor, in a development based on or in
  • control variables in particular pulse width modulation ratios, for at least two, in particular three, windings, in particular stator windings, of the electric motor, in particular based on or dependent on control variables, in particular control variables, for or into or from a converter for energizing the winding (s) and / or for or into or from a vector control.
  • Frequency converters of or for electric motors, in particular three-phase motors are often corresponding control variables, in particular so controlled variables, in particular field and / or Medutierwinkel and / or
  • Pulse width modulation ratios that depend on the counter-voltage that is induced by a movement of the (respective) axis in the electric motor, and therefore can be used advantageously to determine the second parameter.
  • the robot has a
  • Robot arm with one or more, in particular at least four, in particular at least six, in particular at least seven, (movement) axes, in particular axes of rotation, and drive (s) with electric motor (s) for moving, in particular turning, and a system for the secure detection of positions and / or speeds of this axis (s) as described herein.
  • robot arms with (at least) six axes which can perform correspondingly complex work tasks, and in particular in redundant
  • Robotic arms with at least seven axes which are used even more often in direct human-machine interactions, is a secure detection of
  • the or one or more of the electric motor (s) is or are in one embodiment (a) three-phase motor (s), in particular (a) synchronous or asynchronous motor (s), in particular (one) servomotor (s), in particular with a Inverter, in particular servo and / or frequency converter, in particular with power and / or
  • Control electronics in a development of the second parameter or data, in particular voltages, pulse width ratios and / or field and / or Medutierwinkel determined, based on the system determines the or the second parameter.
  • the one or more of the sensor (s) is or are in one embodiment with the (respective) axis, in particular metrological and / or kinematic, in particular mechanically coupled, in particular fixed or slip-free and / or directly or via a ( part) transmission.
  • the sensor detects the position and / or speed of the (respective) axis of the robot directly or directly, in particular touching or non-contact, or is set up for this purpose, in another embodiment directly or directly the position and / or speed of a coupled to the axis output shaft of the (respective) electric motor or an intermediate transmission, in particular touching or non-contact.
  • the first parameter can be determined advantageously, in particular reliably (er).
  • a means in the sense of the present invention may be designed in terms of hardware and / or software, in particular a data or signal-connected, preferably digital, processing, in particular microprocessor unit (CPU) and / or a memory and / or bus system or multiple programs or program modules.
  • the CPU may be configured to implement instructions implemented as a program stored in a memory system.
  • a storage system may comprise one or more, in particular different, storage media, in particular optical, magnetic, solid state and / or other non-volatile media.
  • the program may be arranged to be capable of embodying the methods described herein, such that the CPU may perform the steps of such
  • control ie, in particular, can.
  • FIG. 1 shows a robot with a robot arm and a system for the reliable determination of its axis positions according to an embodiment of the present invention
  • FIG. 2 shows a method for the reliable determination of the axis positions according to an embodiment of the present invention.
  • Fig. 1 shows a robot with a robot arm having a base 71 and a
  • Tool flange 72 and a system for the safe determination of its axis positions according to an embodiment of the present invention.
  • the robot arm has, between the base 71 and the tool flange 72, six axes of rotation which can be moved or actuated or moved by servo drives with electric three-phase motors 11, 21, 31, 41, 51 and 61 and whose positions are controlled by the drive motor. or joint coordinates qi - q 6 are described or specified.
  • the servo drives can have different sizes.
  • the robot controller 100 executes a method for safely determining the axis positions qi-q 6 of the robot arm, which will be explained in more detail below with reference to FIG. 2.
  • the robot controller 100 switches to a second operating mode by executing step S40 in which it outputs a message of the corresponding axis i ("i! Ü") and shuts down the robot ("STOP").
  • the robot controller 100 proceeds to step S30. In this, it determines the second parameter, if necessary with a
  • the robot controller 100 checks in step S30 if a deviation
  • predetermined limit value G exceeds.
  • the robot controller 100 also switches to the second operation mode by executing step S40 in which it outputs the notification of the corresponding axis i ("i! Ü") and shuts down the robot ("STOP").
  • the robot controller 100 switches to a first operating mode by performing step S50, in which they the position q determined by the resolver i2, as safe determined position in a safety monitoring and / or control, in particular so regulation, in particular position, force and / or speed control, the robot used.
  • step S60 the robot controller 100 checks whether all six axes of the robot have been executed, and then returns (S60: "Y") to step S10, otherwise (S60: “N"), it performs incrementing of the axle counter in step S70 the above-described method for the next axis i + 1 by. It can be seen that by comparing the resolver values with the positions of the electric motor rotors, which are optionally transformed by a gear ratio of a gearbox, the positions which are induced in the motors by back measurement
  • Inverters are determined, a dual-channel is realized.
  • a high safety level can be achieved, for example SIL "4" or "D".
  • axle speeds can also be achieved by means of
  • Tachogenerators, incremental encoders or other speed sensors are the first parameters to be determined. Then, in an embodiment in step S30, the positions of the electric motor rotors based on the induced
  • Time differentiation also determines speeds as second parameters and compared with the first parameters.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

Ein erfindungsgemäßes Verfahren zur sicheren Ermittlung wenigstens einer Stellung (qi) und/oder Geschwindigkeit wenigstens einer Achse (i = 1, 2, 3, 4, 5, 6) eines Roboters umfasst die Schritte: - Ermitteln (S20) eines ersten Parameters (q1, q2, q3, q4, q5, q6), der von einer Stellung und/oder Geschwindigkeit dieser Achse abhängt, mittels eines Sensors (12, 22, 32, 42, 52, 62); - Ermitteln (S30) eines zweiten Parameters (ki), der von einer Gegenspannung abhängt, die durch eine Bewegung dieser Achse in einem Elektromotor (11, 21, 31, 41, 51, 61) zum Antreiben der Achse induziert wird; und - Umschalten von einem ersten Betriebsmodus, in dem der erste Parameter als sicher ermittelter Parameter verwendet wird (S50), in einen zweiten Betriebsmodus, in dem der erste Parameter nicht als sicher ermittelter Parameter verwendet wird (S40), sofern eine Abweichung zwischen dem ersten und zweiten Parameter einen vorgegebenen Grenzwert (Gi) übersteigt.

Description

Beschreibung
Sichere Ermittlung von Achsstellungen und/oder -geschwindigkeiten eines
Roboters
Die vorliegende Erfindung betrifft ein Verfahren und ein System zur sicheren
Ermittlung wenigstens einer Stellung und/oder Geschwindigkeit wenigstens einer Achse eines Roboters sowie einen Roboter mit dem System und ein
Computerprogrammprodukt zur Durchführung des Verfahrens.
Achsstellungen und/oder -geschwindigkeiten von Robotern müssen für verschiedene Zwecke sicher ermittelt werden, beispielsweise für eine Sicherheitsüberwachung und/oder (sichere) Steuerung des Roboters, wobei vorliegend zur kompakteren Darstellung auch eine Regelung verallgemeinernd als Steuerung bezeichnet wird.
Hierzu ist betriebsintern insbesondere eine Ermittlung mittels redundanter Auswertung von Resolvern bekannt.
Die WO 2010/060506 A1 schlägt demgegenüber vor, Achsstellungen
und/oder -geschwindigkeiten (bereits) als sicher auszugeben, falls deren zeitliche Änderung in einem plausiblen Bereich liegt.
Die DE 10 2013 005 941 A1 betrifft eine Energierückgewinnung bei Elektromotoren und lehrt, deren Drehstellungen mittels Resolvern zu messen oder alternativ den Drehwinkel und die Drehzahl auf der Grundlage des Wechselstroms und der dem Elektromotor zugeleiteten Spannung zu berechnen.
Aufgabe der vorliegenden Erfindung ist es, eine sichere Ermittlung wenigstens einer Stellung wenigstens einer Achse eines Roboters zur Verfügung zu stellen.
Diese Aufgabe wird durch ein Verfahren mit den Merkmalen des Anspruchs 1 gelöst. Ansprüche 8, 10 stellen ein System bzw. Computerprogrammprodukt zur
Durchführung eines hier beschriebenen Verfahrens unter Schutz, Anspruch 9 einen Roboter mit einem hier beschriebenen System. Die Unteransprüche betreffen vorteilhafte Weiterbildungen. Nach einer Ausführung der vorliegenden Erfindung umfasst ein Verfahren zur sicheren Ermittlung einer oder mehrerer Stellungen und/oder Geschwindigkeiten einer oder mehrerer Achsen eines Roboters die Schritte: (jeweils)
- Ermitteln eines ersten Parameters, der von einer Stellung und/oder
Geschwindigkeit der (jeweiligen) Achse abhängt, insbesondere auf Basis bzw. in Abhängigkeit von der Stellung bzw. Geschwindigkeit, mittels eines Sensors;
- Ermitteln eines zweiten Parameters, der von einer, insbesondere elektrischen, Gegenspannung abhängt, die durch eine Bewegung dieser Achse in einem
Elektromotor induziert wird, der die Achse antreibt bzw. hierzu eingerichtet ist bzw. verwendet wird, insbesondere auf Basis bzw. in Abhängigkeit von der
Gegenspannung, insbesondere eines zweiten Parameters, der von einer
(Rotor)Stellung und/oder Geschwindigkeit dieses Elektromotors abhängt, insbesondere auf Basis bzw. in Abhängigkeit von der (Rotor)Stellung bzw.
Geschwindigkeit; und
- Umschalten von einem ersten Betriebsmodus, in dem dieser erste Parameter als sicher ermittelter Parameter verwendet, insbesondere ausgegeben und/oder einer Sicherheitsüberwachung und/oder Steuerung, insbesondere also Regelung, des Roboters zugrunde gelegt, wird, in einen zweiten Betriebsmodus, in dem der erste Parameter nicht als sicher ermittelter Parameter verwendet, insbesondere ausgegeben und/oder einer Sicherheitsüberwachung und/oder Steuerung, insbesondere also Regelung, des Roboters zugrunde gelegt, wird, sofern eine Abweichung zwischen diesem ersten und zweiten Parameter einen vorgegebenen Grenzwert übersteigt, insbesondere Umschalten von dem ersten in den zweiten Betriebsmodus, sofern eine Abweichung zwischen wenigstens einem der ersten und zweiten Parameter einen, insbesondere achsspezifischen bzw. achsspezifisch vorgegebenen, Grenzwert übersteigt.
Die zumindest eine Achse des Roboters (Roboterachse) ist bevorzugt schlupffrei mit einer zugeordneten Achse des Elektromotors (Elektromotorachse) mechanisch gekoppelt, der die Roboterachse antreibt. Es kann aber auch ein Schlupf auftreten, insbesondere wenn zwischen der Elektromotorachse und der Roboterachse ein Getriebe angeordnet ist. In besonderen Fällen können die Roboterachse und die zugeordnete Elektromotorachse zueinander fluchten oder einstückig ausgebildet sein. Nach einer Ausführung der vorliegenden Erfindung ist ein System, insbesondere hard- und/oder Software-, insbesondere programmtechnisch, zur Durchführung eines hier beschriebenen Verfahrens eingerichtet ist und/oder weist zur sicheren Ermittlung einer oder mehrerer Stellungen und/oder Geschwindigkeiten einer oder mehrerer Achsen eines Roboters (Roboterachse) auf:
- Mittel zum Ermitteln (jeweils) eines ersten Parameters, der von einer Stellung
und/oder Geschwindigkeit der (jeweiligen) Achse (Roboterachse) abhängt, insbesondere auf Basis bzw. in Abhängigkeit von der Stellung bzw.
Geschwindigkeit, mittels eines Sensors;
- Mittel zum Ermitteln (jeweils) eines zweiten Parameters, der von einer,
insbesondere elektrischen, Gegenspannung abhängt, die durch eine Bewegung dieser Achse in einem Elektromotors (Elektromotorachse) induziert wird, der die Achse (Roboterachse) antreibt bzw. hierzu eingerichtet ist bzw. verwendet wird, insbesondere auf Basis bzw. in Abhängigkeit von der Gegenspannung,
insbesondere eines zweiten Parameters, der von einer (Rotor)Stellung und/oder Geschwindigkeit dieses Elektromotors abhängt, insbesondere auf Basis bzw. in Abhängigkeit von der (Rotor)Stellung bzw. Geschwindigkeit; und
- Mittel zum Umschalten von einem ersten Betriebsmodus, in dem dieser erste
Parameter als sicher ermittelter Parameter verwendet, insbesondere ausgegeben und/oder einer Sicherheitsüberwachung und/oder Steuerung, insbesondere also
Regelung, des Roboters zugrunde gelegt, wird, in einen zweiten Betriebsmodus, in dem der erste Parameter nicht als sicher ermittelter Parameter verwendet, insbesondere ausgegeben und/oder einer Sicherheitsüberwachung und/oder Steuerung, insbesondere also Regelung, des Roboters zugrunde gelegt, wird, sofern eine Abweichung zwischen diesem ersten und zweiten Parameter einen vorgegebenen Grenzwert übersteigt, insbesondere zum Umschalten von dem ersten in den zweiten Betriebsmodus, sofern eine Abweichung zwischen wenigstens einem der ersten und zweiten Parameter einen, insbesondere achsspezifischen bzw. achsspezifisch vorgegebenen, Grenzwert übersteigt. Dies basiert auf der Tatsache, dass (Dreh)Bewegungen eines Rotors eines
Elektromotors in dessen Statorwicklungen Gegenspannungen induzieren, die zurückgemessen werden können, wie dies beispielsweise zur sensorlose Regelung, insbesondere mittels Blockkommutierung, und/oder zu einer Vektorregelung an sich bekannt ist. Daher kann der zweite Parameter bevorzugt lediglich von der
Rotorstellung abhängen bzw. bevorzugt von der Drehzahl bzw. Geschwindigkeit des Elektromotors unabhängig sein. Dagegen kann die Auswertbarkeit bzw. die Konfidenz des zweiten Parameters von der Drehzahl bzw. Geschwindigkeit des Elektromotors abhängig sein, insbesondere da die Bestimmung des mit der Rotorstellung
korrelierenden zweiten Parameters ein Signal-Rausch-Verhältnis aufweisen kann, welches sich mit steigender Drehzahl verbessert. Zweckmäßigerweise kann daher eine Verwendung des ermittelten zweiten Parameters als Kriterium zum Umschalten für den Fall erfolgen, dass die Drehzahl des Elektromotors eine vorbestimmte
Mindestdrehzahl übersteigt. Im anderen Fall, also für Drehzahlen des Elektromotors unterhalb der Mindestdrehzahl, bewegt sich der Roboter bevorzugt derart langsam oder steht still, dass keine Gefährdung durch die Bewegung des Roboters vorliegt.
Hierauf aufbauend liegt der vorliegenden Erfindung der Gedanke zugrunde, diese induzierte(n) Gegenspannung(en), die von der Stellung des Rotors zu der bzw. den Statorwicklung(en) abhängt, zu nutzen, um zusätzlich zu dem Sensor bzw. dem mittels diesem ermittelten ersten Parameter einen weiteren, zweiten Parameter zu ermitteln, der ebenfalls von der Stellung bzw. den zeitlich aufeinanderfolgenden Stellungen des Rotors und damit der Achse abhängt, und auf dessen Basis die Zuverlässigkeit des Sensors bzw. ersten Parameters zu überprüfen. Hierdurch kann in einer Ausführung der erste Parameter bzw. die Achsstellung und/oder - geschwindigkeit sicher(er) ermittelt werden.
Entsprechend umfasst in einer Ausführung der erste Parameter die mittels des Sensors ermittelte, insbesondere aktuelle, Stellung und/oder Geschwindigkeit der (jeweiligen) Achse bzw. gibt diese an. Zusätzlich oder alternativ umfasst in einer Ausführung der zweite Parameter (jeweils) eine auf Basis bzw. in Abhängigkeit von der/den induzierten Gegenspannung(en) ermittelte(n), insbesondere aktuelle, Stellung des Elektromotors, insbesondere seines Rotors bzw. seiner Abtriebswelle, und/oder der damit gekoppelten Achse des Roboters und/oder deren zeitliche Änderung bzw. Geschwindigkeit, bzw. gibt diese an. Dabei kann in einer Ausführung aus mehreren aufeinanderfolgenden (Rotor)Stellungen des Elektromotors dessen
(Dreh)Geschwindigkeit ermittelt werden.
In einer Ausführung weist das Verfahren die Schritte auf: - Ermitteln einer zeitlichen Änderung des (jeweiligen) ersten Parameters; und
- Umschalten von dem ersten in den zweiten Betriebsmodus (auch), sofern diese zeitliche Änderung nicht in einem vorgegebenen plausiblen Bereich liegt, insbesondere die zeitlichen Änderungen wenigstens eines der ersten Parameter nicht in einem vorgegebenen plausiblen Bereich liegt.
Eine zeitliche Änderung im Sinne der Erfindung kann neben der zeitlichen Ableitung auch (normierte) Kreuzkorrelationen zwischen dem zeitlich Verlauf der ersten und zweiten Parameter umfassen. In diesem Fall wird die Kreuzkorrelationsfunktion für eine Mehrzahl von ermittelten bzw. gemessenen ersten und zweiten Parametern in einem vorbestimmten Zeitintervall (Zeitreihen der ersten und zweiten Parameter) für zumindest eine, bevorzugt mehrere, zeitliche Verschiebung(en) bzw.
Phasenverschiebung(en) ermittelt bzw. berechnet. Bevorzugt kann durch eine
Normierung der Wertebereich der Kreuzkorrelation zwischen 0 und 1 liegen. Ein plausibler Bereich kann dann als ein Bereich mit einer Korrelation größer als ein vorbestimmter Korrelationskoeffizient definiert sein, beispielsweise als Bereich mit einem Korrelationskoeffizient größer als 0,6, bevorzugt größer als 0,8, besonders bevorzugt größer als 0,9, wobei der Korrelationskoeffizient beispielsweise für eine einzige zeitliche Verschiebung (auch eine Verschiebung von 0) bestimmt werden kann bzw. als Mittelwert aus mehreren zeitlichen Verschiebungen oder als maximaler Wert für alle möglichen durch die Korrelationsfunktion ermittelbaren zeitlichen
Verschiebungen. Vorteilhafterweise können durch die Verwendung von
Korrelationsfunktionen auch über die Zeit gestörte bzw. nicht ideale ermittelte erste und zweite Parameter zur Plausibilitätsentscheidung verwendet werden.
Entsprechend weist das System in einer Ausführung Verfahren auf:
- Mittel zum Ermitteln einer zeitlichen Änderung des (jeweiligen) ersten Parameters; und
- Mittel zum Umschalten von dem ersten in den zweiten Betriebsmodus (auch), sofern diese zeitliche Änderung nicht in einem vorgegebenen plausiblen Bereich liegt, insbesondere die zeitlichen Änderungen wenigstens eines der ersten
Parameter nicht in einem vorgegebenen plausiblen Bereich liegt.
Der (jeweilige) plausible Bereich ist, insbesondere wird, in einer Ausführung auf Basis einer Dynamik des Roboters und/oder des (jeweiligen) Sensors vorgegeben. Diesbezüglich wird ergänzend auf die eingangs genannte WO 2010/060506 A1 Bezug genommen und deren Inhalt vollständig in die vorliegende Offenbarung einbezogen.
Indem der erste Parameter somit in einer Ausführung einerseits anhand des zweiten Parameters und zusätzlich seine Plausibilität auf Basis der Dynamik des Roboters und/oder des (jeweiligen) Sensors überprüft wird, kann in einer Ausführung der erste Parameter bzw. die Achsstellung (noch) sicher(er) ermittelt werden.
Dies ermöglicht es in einer Ausführung, den ersten Parameter nicht redundant zu ermitteln und gleichwohl den Roboter sicher zu überwachen und/oder zu steuern, insbesondere also zu regeln, insbesondere mit einem Safety Integrity Level (SIL) „3" bzw.„C", insbesondere SIL„4" bzw.„D", gemäß IEC 61508.
Das kann in einer Ausführung vorteilhaft einen Informations-, insbesondere
Signalübertragungs- und/oder -Verarbeitungsaufwand, insbesondere eine (Rechenbzw. Übertragungs)Zeit, reduzieren, der bzw. die bei einer redundanten Ermittlung des ersten Parameters gegenüber einer nicht redundanten Ermittlung signifikant höher ist. Durch eine solche Reduzierung kann in einer Ausführung insbesondere eine Sicherheitsüberwachung und/oder Steuerung, insbesondere also eine Regelung, des Roboters verbessert werden, insbesondere deren Taktzeit.
In einer Ausführung wird in dem zweiten Betriebsmodus eine Meldung ausgegeben. Entsprechend weist in einer Ausführung das System Mittel zum Ausgeben einer Meldung in dem zweiten Betriebsmodus auf.
Auf Basis einer solchen Meldung kann eine Sicherheitsüberwachung und/oder Steuerung des Roboters entsprechende (Gegen)Maßnahmen einleiten, insbesondere wenigstens die Geweilige) Achse(n), insbesondere alle Achsen bzw. den Roboter, stillsetzen. Entsprechend weist in einer Ausführung das System Mittel zum Stillsetzen wenigstens der (jeweiligen) Achse(n), insbesondere aller Achsen bzw. des Roboters, in dem zweiten Betriebsmodus auf.
Zusätzlich oder alternativ können Personen in der Nähe des Roboters und/oder Bedienpersonen auf die nicht sichere Ermittlung und hieraus resultierende mögliche Fehlfunktionen des Roboters hingewiesen werden. Entsprechend wird in einer Ausführung die Meldung visuell, akustisch und/oder haptisch ausgegeben bzw. ist das Mittel zum Ausgeben einer Meldung hierzu eingerichtet bzw. wird hierzu verwendet.
In einer Ausführung weist der Sensor (jeweils wenigstens) einen, insbesondere berührend oder berührungslos messenden, Winkel- und/oder (jeweils wenigstens) einen, insbesondere berührend oder berührungslos messenden,
Geschwindigkeitsmesser, insbesondere Resolver und/oder Tachogenerator und/oder Inkrementalgeber, auf, er kann insbesondere ein solcher sein. Insbesondere bei solchen Sensoren kann vorteilhaft eine redundante Auswertung eingespart und/oder eine Signalübertragung und/oder -Verarbeitung reduziert werden.
In einer Ausführung wird der zweite Parameter auf Basis bzw. in Abhängigkeit von einer gemessenen Spannung in wenigstens einer Wicklung, insbesondere
Statorwicklung, des Elektromotors, in einer Weiterbildung auf Basis bzw. in
Abhängigkeit von gemessenen Spannungen in wenigstens zwei, insbesondere drei, Wicklungen, insbesondere Statorwicklungen, des Elektromotors ermittelt.
Entsprechend weist in einer Ausführung das System Mittel auf zum Ermitteln des zweiten Parameters auf Basis bzw. in Abhängigkeit von einer gemessenen Spannung in wenigstens einer Wicklung, insbesondere Statorwicklung, des Elektromotors, in einer Weiterbildung auf Basis bzw. in Abhängigkeit von gemessenen Spannungen in wenigstens zwei, insbesondere drei, Wicklungen, insbesondere Statorwicklung, des Elektromotors.
Mittels Messung einer Spannung in wenigstens einer (Stator)Wicklung kann der zweite Parameter in einer Ausführung, insbesondere messtechnisch, einfach und/oder präzise ermittelt werden, mittels Messung in wenigstens zwei, insbesondere drei, Wicklungen in einer Ausführung vorteilhaft, insbesondere zuverlässig(er) und/oder genau(er).
Zusätzlich oder alternativ wird in einer Ausführung der zweite Parameter auf Basis bzw. in Abhängigkeit von einer Steuergröße, insbesondere also Regelgröße, insbesondere eines Feld- und/oder eines Kommutierwinkels und/oder eines
Pulsweitenmodulationsverhältnisses, für wenigstens eine Wicklung, insbesondere Statorwicklung, des Elektromotors, in einer Weiterbildung auf Basis bzw. in Abhängigkeit von Steuergrößen, insbesondere also Regelgrößen, insbesondere Pulsweitenmodulationsverhältnissen, für wenigstens zwei, insbesondere drei, Wicklungen, insbesondere Statorwicklungen, des Elektromotors, insbesondere auf Basis bzw. in Abhängigkeit von Steuergrößen, insbesondere also Regelgrößen, für einen bzw. in bzw. von einem Umrichter zum Bestromen der Wicklung(en) und/oder für eine bzw. in bzw. von einer Vektorregelung, ermittelt. Entsprechend weist in einer Ausführung das System Mittel auf zum Ermitteln des zweiten Parameters auf Basis bzw. in Abhängigkeit von einer Steuergröße, insbesondere also Regelgröße, insbesondere eines Feld- und/oder eines Kommutierwinkels und/oder eines
Pulsweitenmodulationsverhältnisses, für wenigstens eine Wicklung, insbesondere Statorwicklung, des Elektromotors, in einer Weiterbildung auf Basis bzw. in
Abhängigkeit von Steuergrößen, insbesondere also Regelgrößen, insbesondere Pulsweitenmodulationsverhältnissen, für wenigstens zwei, insbesondere drei, Wicklungen, insbesondere Statorwicklungen, des Elektromotors, insbesondere auf Basis bzw. in Abhängigkeit von Steuergrößen, insbesondere also Regelgrößen, für einen bzw. in bzw. von einem Umrichter zum Bestromen der bzw. der Wicklung(en) und/oder für eine bzw. in bzw. von einer Vektorregelung.
Insbesondere bei Servoantrieben mit bzw. Umrichtern, insbesondere
Frequenzumrichtern, von bzw. für Elektromotoren, insbesondere Drehstrommotoren, stehen häufig entsprechende Steuergrößen, insbesondere also Regelgrößen, insbesondere Feld- und/oder Kommutierwinkel und/oder
Pulsweitenmodulationsverhältnisse, die von der Gegenspannung abhängen, die durch eine Bewegung der (jeweiligen) Achse in dem Elektromotor induziert wird, zur Verfügung und können daher vorteilhaft zur Ermittlung des zweiten Parameters genutzt werden.
Diesbezüglich wird ergänzend auf die eingangs genannte DE 10 2013 005 941 A1 Bezug genommen und deren Inhalt vollständig in die vorliegende Offenbarung einbezogen.
Nach einer Ausführung der vorliegenden Erfindung weist der Roboter einen
Roboterarm mit einer oder mehreren, insbesondere wenigstens vier, insbesondere wenigstens sechs, insbesondere wenigstens sieben, (Bewegungs)Achsen, insbesondere Drehachsen, und Antrieb(e) mit Elektromotor(en) zum Bewegen, insbesondere Drehen, sowie ein System zur sicheren Erfassung von Stellungen und/oder Geschwindigkeiten dieser Achse(n) wie hier beschrieben auf. Insbesondere bei Roboterarmen mit (wenigstens) sechs Achsen, die entsprechend komplexe Arbeitsaufgaben durchführen können, und insbesondere bei redundanten
Roboterarmen mit wenigstens sieben Achsen, die noch häufiger in direkten Mensch- Maschine-Interaktionen eingesetzt werden, ist eine sichere Erfassung von
Achsstellungen und/oder -geschwindigkeiten wie hier beschrieben besonders vorteilhaft.
Der bzw. einer oder mehrere der Elektromotor(en) ist bzw. sind in einer Ausführung (ein) Drehstrommotor(en), insbesondere (ein) Synchron- oder Asynchronmotor(en), insbesondere (ein) Servomotor(en), insbesondere mit einem Umrichter, insbesondere Servo- und/oder Frequenzumrichter, insbesondere mit Leistungs- und/oder
Steuerelektronik, die in einer Weiterbildung den bzw. die zweiten Parameter oder Daten, insbesondere Spannungen, Pulsweitenverhältnisse und/oder Feld- und/oder Kommutierwinkel, ermittelt, auf deren Basis das System den bzw. die zweiten Parameter ermittelt.
Der bzw. einer oder mehrere der Sensor(en) ist bzw. sind in einer Ausführung mit der (jeweiligen) Achse, insbesondere messtechnisch und/oder kinematisch, insbesondere mechanisch, gekoppelt, insbesondere fest bzw. schlupffrei und/oder direkt oder über ein (Teil)Getriebe. In einer Ausführung erfasst der Sensor die Stellung und/oder Geschwindigkeit der (jeweiligen) Achse des Roboters direkt bzw. unmittelbar, insbesondere berührend oder berührungslos, bzw. ist hierzu eingerichtet, in einer anderen Ausführung direkt bzw. unmittelbar die Stellung und/oder Geschwindigkeit einer mit der Achse gekoppelten Abtriebswelle des (jeweiligen) Elektromotors oder eines zwischengeschalteten Getriebes, insbesondere berührend oder berührungslos. In einer Ausführung ist er an der (jeweiligen) Achse oder der damit gekoppelten Getriebe- oder Abtriebswelle des Elektromotors angeordnet, insbesondere fest mit dieser Achse bzw. Welle verbunden, insbesondere zerstörungsfrei lösbar, insbesondere reib- und/oder formschlüssig, beispielsweise durch Schrauben, Verrasten, Stecken oder dergleichen, oder nicht zerstörungsfrei lösbar, insbesondere stoffschlüssig, beispielsweise durch Kleben, Löten, oder dergleichen. Hierdurch kann der erste Parameter (jeweils) vorteilhaft, insbesondere zuverlässig(er) ermittelt werden. Ein Mittel im Sinne der vorliegenden Erfindung kann hard- und/oder softwaretechnisch ausgebildet sein, insbesondere eine, vorzugsweise mit einem Speicher- und/oder Bussystem daten- bzw. signalverbundene, insbesondere digitale, Verarbeitungs-, insbesondere Mikroprozessoreinheit (CPU) und/oder ein oder mehrere Programme oder Programmmodule aufweisen. Die CPU kann dazu ausgebildet sein, Befehle, die als ein in einem Speichersystem abgelegtes Programm implementiert sind,
abzuarbeiten, Eingangssignale von einem Datenbus zu erfassen und/oder
Ausgangssignale an einen Datenbus abzugeben. Ein Speichersystem kann ein oder mehrere, insbesondere verschiedene, Speichermedien, insbesondere optische, magnetische, Festkörper- und/oder andere nicht-flüchtige Medien aufweisen. Das Programm kann derart beschaffen sein, dass es die hier beschriebenen Verfahren verkörpert bzw. auszuführen imstande ist, sodass die CPU die Schritte solcher
Verfahren ausführen kann und damit insbesondere eine oder mehrere Achsstellungen und/oder -geschwindigkeiten des Roboters sicher(er) ermitteln und in einer
Weiterbildung den Roboter auf Basis der sicher erfassten Achsstellungen bzw.
und/oder -geschwindigkeiten überwachen und/oder steuern, insbesondere also regeln, kann.
In einer Ausführung werden ein oder mehrere, insbesondere alle, Schritte des
Verfahrens vollständig oder teilweise automatisiert durchgeführt, insbesondere durch das System bzw. seine Mittel.
Weitere Vorteile und Merkmale ergeben sich aus den Unteransprüchen und den Ausführungsbeispielen. Hierzu zeigt, teilweise schematisiert,:
Fig. 1 : einen Roboter mit einem Roboterarm und einem System zur sicheren Ermittlung von dessen Achsstellungen nach einer Ausführung der vorliegenden Erfindung; und
Fig. 2: ein Verfahren zur sicheren Ermittlung der Achsstellungen nach einer Ausführung der vorliegenden Erfindung.
Fig. 1 zeigt einen Roboter mit einem Roboterarm, der eine Basis 71 und einen
Werkzeugflansch 72 aufweist, und einem System zur sicheren Ermittlung von dessen Achsstellungen nach einer Ausführung der vorliegenden Erfindung. Der Roboterarm weist zwischen Basis 71 und Werkzeugflansch 72 sechs Drehachsen auf, die durch Servoantriebe mit Elektro-Drehstrommotoren 1 1 , 21 , 31 , 41 , 51 bzw. 61 beweg- bzw. aktuierbar sind bzw. bewegt werden und deren Stellungen durch die Antriebs- bzw. Gelenkkoordinaten qi - q6 beschrieben bzw. angegeben werden. Die Servoantriebe können unterschiedliche Baugrößen aufweisen. Sie weisen jeweils einen Resolver 12, 22, 32, 42, 52 bzw. 62 zum Ermitteln der Stellung qi - q6 sowie Umrichter mit Leistungs- und Steuerelektronik 13, 23, 33, 43, 53 bzw. 63 auf, die vorliegend als Teil einer Robotersteuerung 100 betrachtet werden, welche zusätzlich übergeordnete Steuer-, insbesondere also Regelschichten, insbesondere eine Positions-, Kraft-, Geschwindigkeits- und/oder Momentenregelung, insbesondere
Einzelachs- bzw. -gelenkregelung, und/oder Sicherheitsüberwachung aufweisen bzw. implementieren kann.
Im Betrieb des Roboters führt die Robotersteuerung 100 ein Verfahren zur sicheren Ermittlung der Achsstellungen qi - q6 des Roboterarms aus, das nachfolgend mit Bezug auf Fig. 2 näher erläutert wird.
In einem Schritt S10 wird ein Achszähler i für die erste Achse initialisiert (i = 1 ).
In einem darauffolgenden Schritt S20 ermittelt die Robotersteuerung 100 mittels des fest mit der jeweiligen Achse i gekoppelten Resolvers i2 als ersten Parameter die Stellung q, dieser Achse und durch Vergleich mit einem oder mehreren vorhergehend für diese Achse i ermittelten Stellungen q, eine Zeitableitung, beispielsweise eine Geschwindigkeit dq, /dt, Beschleunigung d2q, /dt2 oder einen Ruck d3q, /dt3 (n = 1 , 2, 3,...) dieser Achse. Dann prüft die Robotersteuerung 100 in Schritt S20, ob diese Zeitableitung in einem vorgegebenen plausiblen Bereich P, liegt.
Ist dies nicht der Fall (S20:„N"), schaltet die Robotersteuerung 100 in einen zweiten Betriebsmodus um, indem sie Schritt S40 ausführt, in welchem sie eine Meldung der entsprechenden Achse i („i!ü") ausgibt und den Roboter stillsetzt („STOP").
Liegt die Zeitableitung in dem vorgegebenen plausiblen Bereich P, (S20:„Y"), fährt die Robotersteuerung 100 mit Schritt S30 fort. In diesem ermittelt sie als zweiten Parameter die, gegebenenfalls mit einem
Übersetzungsverhältnis eines Getriebes transformierte, Stellung k, des Rotors des Elektromotors des Servoantriebs der Achse i mittels Zurückmessen der in dem Motor induzierten Gegenspannung bzw. auf Grundlage des Wechselstroms und der dem Motor zugeleiteten Spannung, insbesondere auf Basis von Feld- und/oder
Kommutierwinkeln und/oder Pulsweitenmodulationsverhältnissen der Leistungs- und Steuerelektronik der Umrichter 13, 23, 63, da diese von der aktuellen Stellung des Rotors abhängen. Dann prüft die Robotersteuerung 100 in Schritt S30, ob eine Abweichung | q, - k, | zwischen dem ersten und zweiten Parameter einen
vorgegebenen Grenzwert G, übersteigt.
Ist dies der Fall (S30:„Y"), schaltet die Robotersteuerung 100 ebenfalls in den zweiten Betriebsmodus um, indem sie Schritt S40 ausführt, in welchem sie die Meldung der entsprechenden Achse i („i!ü") ausgibt und den Roboter stillsetzt („STOP").
Übersteigt die Abweichung | q, - k, | zwischen dem ersten und zweiten Parameter den vorgegebenen Grenzwert G, nicht (S30:„N"), schaltet die Robotersteuerung 100 in einen ersten Betriebsmodus um, indem sie Schritt S50 ausführt, in welchem sie die mittels des Resolvers i2 ermittelte Stellung q, als sicher ermittelte Stellung in einer Sicherheitsüberwachung und/oder Steuerung, insbesondere also Regelung, insbesondere Positions-, Kraft- und/oder Geschwindigkeitsregelung, des Roboters verwendet.
In einem darauffolgenden Schritt S60 prüft die Robotersteuerung 100, ob alle sechs Achsen des Roboters abgearbeitet worden sind und kehrt dann (S60:„Y") zu Schritt S10 zurück, andernfalls (S60:„N") führt sie unter Inkremetierung des Achszählers in Schritt S70 das oben beschriebene Verfahren für die nächste Achse i+1 durch. Man erkennt, dass durch den Vergleich der Resolverwerte mit den, gegebenenfalls mit einem Übersetzungsverhältnis eines Getriebes transformierten, Stellungen der Elektromotorrotoren, die durch Zurückmessen der in den Motoren induzierten
Gegenspannungen bzw. auf Basis von Feld- und/oder Kommutierwinkeln und/oder Pulsweitenmodulationsverhältnissen der Leistungs- und Steuerelektronik der
Umrichter ermittelt werden, eine Zweikanaligkeit realisiert wird. Insbesondere in Kombination mit der zusätzlichen Plausibilitätskontrolle (S20) kann so ein hohes Sicherheitslevel, beispielsweise SIL„4" bzw.„D", realisiert werden.
Obwohl in der vorhergehenden Beschreibung exemplarische Ausführungen erläutert wurden, sei darauf hingewiesen, dass eine Vielzahl von Abwandlungen möglich ist. So wurde vorliegende eine sichere Ermittlung von Achsstellungen mittels Resolvern erläutert. In analoger Weise können auch Achsgeschwindigkeiten mittels
Tachogeneratoren, Inkrementalgebern oder anderen Geschwindigkeitssensoren als erste Parameter ermittelt werden. Dann werden in einer Ausführung in Schritt S30 aus den Stellungen der Elektromotorrotoren, die auf Basis der induzierten
Gegenspannungen ermittelt werden, durch, insbesondere numerische,
Zeitdifferentiation auch Geschwindigkeiten als zweite Parameter ermittelt und mit den ersten Parametern verglichen.
Außerdem sei darauf hingewiesen, dass es sich bei den exemplarischen
Ausführungen lediglich um Beispiele handelt, die den Schutzbereich, die
Anwendungen und den Aufbau in keiner Weise einschränken sollen. Vielmehr wird dem Fachmann durch die vorausgehende Beschreibung ein Leitfaden für die
Umsetzung von mindestens einer exemplarischen Ausführung gegeben, wobei diverse Änderungen, insbesondere in Hinblick auf die Funktion und Anordnung der beschriebenen Bestandteile, vorgenommen werden können, ohne den Schutzbereich zu verlassen, wie er sich aus den Ansprüchen und diesen äquivalenten
Merkmalskombinationen ergibt.
Bezuqszeichenliste
11, 21, 31,
41,51,61 Elektromotor
12,22,32,
42, 52, 62 Resolver
13, 23, 33,
43, 53, 63 Umrichter
71 Basis
72 Werkzeugflansch
100 Robotersteuerung
Gi vorgegebener Grenzwert
ki,..., k6 mittels Umrichter i3 ermittelte Rotorstellung
P, vorgegebener plausibler Bereich qi,..., q6 mittels Resolver i2 ermittelte Achsstellung

Claims

Patentansprüche
Verfahren zur sicheren Ermittlung wenigstens einer Stellung (q,) und/oder
Geschwindigkeit wenigstens einer Achse (i = 1 ,
2,
3,
4,
5, 6) eines Roboters, mit den Schritten:
- Ermitteln (S20) eines ersten Parameters (q-ι, q2, q3, q4, qs, qö), der von einer Stellung und/oder Geschwindigkeit dieser Achse abhängt, mittels eines Sensors (12, 22, 32, 42, 52, 62);
- Ermitteln (S30) eines zweiten Parameters (k,), der von einer Gegenspannung abhängt, die durch eine Bewegung dieser Achse in einem Elektromotor (1 1 , 21 31 , 41 , 51 , 61 ) zum Antreiben der Achse induziert wird; und
- Umschalten von einem ersten Betriebsmodus, in dem der erste Parameter als sicher ermittelter Parameter verwendet wird (S50), in einen zweiten
Betriebsmodus, in dem der erste Parameter nicht als sicher ermittelter
Parameter verwendet wird (S40), sofern eine Abweichung zwischen dem ersten und zweiten Parameter einen vorgegebenen Grenzwert (G,) übersteigt.
Verfahren nach Anspruch 1 , gekennzeichnet durch die Schritte:
- Ermitteln (S20) einer zeitlichen Änderung des ersten Parameters; und
- Umschalten von dem ersten in den zweiten Betriebsmodus, sofern die zeitliche Änderung nicht in einem vorgegebenen plausiblen Bereich (P,) liegt.
Verfahren nach Anspruch 2, dadurch gekennzeichnet, dass der plausible Bereich auf Basis einer Dynamik des Roboters und/oder des Sensors vorgegeben ist.
Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass in dem zweiten Betriebsmodus eine Meldung ausgegeben und/oder die Achse stillgesetzt wird.
Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass der erste Parameter nicht redundant ermittelt wird.
6. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass der Sensor einen Winkel- und/oder Geschwindigkeitsmesser, insbesondere einen Resolver (12, 22, 32, 42, 52, 62), aufweist.
7. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass der zweite Parameter auf Basis einer gemessenen Spannung in wenigstens einer Wicklung des Elektromotors und/oder einer Steuergröße, insbesondere eines Feld- und/oder eines Kommutierwinkels und/oder
Pulsweitenmodulationsverhältnisses, für wenigstens eine Wicklung des
Elektromotors ermittelt wird.
8. System (100) zur sicheren Ermittlung wenigstens einer Stellung (q,) und/oder Geschwindigkeit wenigstens einer Achse (i = 1 , 2, 3, 4, 5, 6) eines Roboters, das zur Durchführung eines Verfahrens nach einem der vorhergehenden Ansprüche eingerichtet ist und/oder aufweist:
- Mittel (100) zum Ermitteln eines ersten Parameters (q-ι, q2, q3, q4, qs, qö), der von einer Stellung und/oder Geschwindigkeit dieser Achse abhängt, mittels eines Sensors (12, 22, 32, 42, 52, 62);
- Mittel (100) Ermitteln (S30) eines zweiten Parameters (k,), der von einer
Gegenspannung abhängt, die durch eine Bewegung dieser Achse in einem
Elektromotor (11 , 21 , 31 , 41 , 51 , 61 ) zum Antreiben der Achse induziert wird; und
- Mittel (100) zum Umschalten von einem ersten Betriebsmodus, in dem der erste Parameter als sicher ermittelter Parameter verwendet wird, in einen zweiten Betriebsmodus, in dem der erste Parameter nicht als sicher ermittelter
Parameter verwendet wird, sofern eine Abweichung zwischen dem ersten und zweiten Parameter einen vorgegebenen Grenzwert (G,) übersteigt.
9. Roboter mit einem Roboterarm mit wenigstens einer Achse und einem System (100) zur sicheren Erfassung einer Stellung und/oder Geschwindigkeit dieser Achse nach einem der vorhergehenden Ansprüche.
10. Computerprogrammprodukt mit einem Programmcode, der auf einem von einem Computer lesbaren Medium gespeichert ist, zur Durchführung eines Verfahrens nach einem der vorhergehenden Ansprüche.
PCT/EP2017/083837 2016-12-21 2017-12-20 Sichere ermittlung von achsstellungen und/oder -geschwindigkeiten eines roboters Ceased WO2018115134A2 (de)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
DE102016015237.0 2016-12-21
DE102016015237.0A DE102016015237B4 (de) 2016-12-21 2016-12-21 Sichere Ermittlung von Achsstellungen und/oder -geschwindigkeiten eines Roboters

Publications (2)

Publication Number Publication Date
WO2018115134A2 true WO2018115134A2 (de) 2018-06-28
WO2018115134A3 WO2018115134A3 (de) 2018-08-30

Family

ID=60957278

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/EP2017/083837 Ceased WO2018115134A2 (de) 2016-12-21 2017-12-20 Sichere ermittlung von achsstellungen und/oder -geschwindigkeiten eines roboters

Country Status (2)

Country Link
DE (1) DE102016015237B4 (de)
WO (1) WO2018115134A2 (de)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109822566B (zh) * 2019-01-15 2021-10-22 深圳镁伽科技有限公司 机器人控制方法、系统及存储介质

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2010060506A1 (de) 2008-11-03 2010-06-03 Kuka Roboter Gmbh Verfahren und vorrichtung zur sicheren erfassung einer kinematischen grösse eines manipulators
DE102013005941A1 (de) 2012-04-13 2013-10-17 Fanuc Corporation Regelvorrichtung für einen Synchronmotor zum Regeln eines Synchronmotors beim Ausführen eines Energierückgewinnungsbetriebs und zum Anhalten des Synchronmotors bei Ausfall der Energieversorgung

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1077527B1 (de) * 1999-08-18 2002-05-29 Holtz, Joachim, Prof. Dr. Ing. Verfahren zur Bremsung eines feldorientiertbetriebenen Asynchronmotors, Regelungsvorrichtung zur Verfahrensausführung und Speichermedium
JP2003033072A (ja) * 2001-07-13 2003-01-31 Yaskawa Electric Corp モータドライブ装置の保護装置
DE10245594A1 (de) * 2002-09-30 2004-04-08 Dürr Systems GmbH Verfahren zur Kollisionserkennung
DE10304019A1 (de) * 2003-02-01 2004-11-04 Kuka Roboter Gmbh Verfahren zum Überwachen einer Maschine und derartige Maschine, insbesondere Roboter
JP4989075B2 (ja) * 2006-01-11 2012-08-01 株式会社日立産機システム 電動機駆動制御装置及び電動機駆動システム
EP1955830B1 (de) * 2007-02-06 2014-04-09 Abb Research Ltd. Verfahren und Steuersystem zur Überwachung des Zustands eines Industrieroboters
JP5696700B2 (ja) * 2012-08-29 2015-04-08 トヨタ自動車株式会社 ロータ位置推定装置、電動機制御システムおよびロータ位置推定方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2010060506A1 (de) 2008-11-03 2010-06-03 Kuka Roboter Gmbh Verfahren und vorrichtung zur sicheren erfassung einer kinematischen grösse eines manipulators
DE102013005941A1 (de) 2012-04-13 2013-10-17 Fanuc Corporation Regelvorrichtung für einen Synchronmotor zum Regeln eines Synchronmotors beim Ausführen eines Energierückgewinnungsbetriebs und zum Anhalten des Synchronmotors bei Ausfall der Energieversorgung

Also Published As

Publication number Publication date
DE102016015237B4 (de) 2019-02-21
WO2018115134A3 (de) 2018-08-30
DE102016015237A1 (de) 2018-06-21

Similar Documents

Publication Publication Date Title
EP2067250B1 (de) Fehlererkennung durch auswertung von grössen der feldorientierten regelung
EP1977188B1 (de) Koordinatenmessgerät und verfahren zum betreiben eines koordinatenmessgeräts
DE102010044644B4 (de) Verfahren zur Kollisionserkennung für eine Antriebseinheit
DE102016108263B4 (de) Servoregelungsvorrichtung mit sensorlos geregelter Stoppfunktion
EP1987316B1 (de) Sichere überwachung der geschwindigkeit bei koordinatenmessgeräten
DE102013005941B4 (de) Regelvorrichtung für einen Synchronmotor zum Regeln eines Synchronmotors beim Ausführen eines Energierückgewinnungsbetriebs und zum Anhalten des Synchronmotors bei Ausfall der Energieversorgung
DE102011001278A1 (de) Verfahren und Vorrichtung zum Steuern eines Anhaltens der Drehung eines Elektromotors zur Verwendung in Maschinen für die Herstellung
DE4330823C2 (de) Antriebsvorrichtung mit einer Sicherheitseinrichtung für den Sonderbetrieb
EP2196292A2 (de) Industrieroboter und Verfahren zum Betreiben eines Industrieroboters
DE102019201569A1 (de) Servo-Steuereinrichtung
WO2011012541A1 (de) Verfahren und vorrichtung zum fehlersicheren überwachen einer bewegungsgrösse an einem elektrischen antrieb
EP2447104A1 (de) Verfahren zur Steuerung einer elektrischen Drehfeldmaschine einer mobilen Arbeitsmaschine
DE102016015237B4 (de) Sichere Ermittlung von Achsstellungen und/oder -geschwindigkeiten eines Roboters
EP1589653A2 (de) Vorrichtung zum Betrieb eines Synchronmotors
EP2568596B1 (de) Verfahren und Verarbeitungseinheit zur Bestimmung der Position des Läufers einer Synchronmaschine in Bezug auf den Stator der Synchronmaschine
DE102018003397B4 (de) Anomaliediagnosevorrichtung und Anomaliediagnoseverfahren
DE102019004308A1 (de) Motorsteuerung
EP2368785A2 (de) Verfahren zur Steuerung eines elektrischen Antriebes einer mobilen Arbeitsmaschine, insbesondere eines Lenkantriebs
EP3086464B1 (de) Verfahren zum betrieb einer elektrischen maschine und antrieb
WO2012150063A2 (de) Verfahren und vorrichtung zum überwachen einer winkellage eines rotors in einer elektromaschine
CN115023666B (zh) 用于监控电机中传感器的故障防护功能的方法
DE102018211068A1 (de) Motorsteuervorrichtung
DE3707770A1 (de) Lageregelung zur reaktionsschnellen positionierung mit einem gleichstromservomotor
EP1879289B1 (de) Drehwinkelbestimmung eines Elektromotors
EP3001271A1 (de) Verfahren und Vorrichtung zur Überwachung einer Bewegungsgröße eines Antriebs

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 17828891

Country of ref document: EP

Kind code of ref document: A2

NENP Non-entry into the national phase in:

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 17828891

Country of ref document: EP

Kind code of ref document: A2