Method and device for controlling motion of an industrial robot with a position switch
First Claim
1. A method for controlling motion of a multi-axis industrial robot or manipulator arranged with a robot control unit, the robot or the control unit also comprising at least one first computer running a servo controller, the method comprising:
- registering a motion limit for at least one axis of said robot arm,providing a reference signal for a robot position to a robot controller,making a measurement of a position of at least one axis of said robot arm for the purpose of limiting the motion of an arm of said robot,providing a motion limit of said at least one said arm by running in at least one computer a model-based evaluator of a position switch, modelling a position of said at least one axis of said robot arm dependent on said reference signal and comparing the modelled position to the measured position,reading reference or target values sent to the servo control for said at least one axis,reading a measurement value for actual motor position for the at least one axis, andmodelling in the model-based evaluator a servo control loop, modelling a gearbox and calculating a first position and a trust value for the first position,wherein a servo loop model for said at least one axis and a model for at least one gearbox is run in the model-based evaluator of the position switch.
3 Assignments
0 Petitions
Accused Products
Abstract
A method for controlling a multi-axis industrial robot or manipulator arranged with a robot control unit. The robot or the control unit includes at least one first computer running a servo controller. A motion limit is configured for at least one axis of the robot arm. A reference signal for a robot position is sent to a robot controller together with a measurement of a position of the robot arm. The reference position is processed and the measured position and the processed reference position are then compared in an evaluator for the purpose of limiting the motion of an arm of the robot.
82 Citations
41 Claims
-
1. A method for controlling motion of a multi-axis industrial robot or manipulator arranged with a robot control unit, the robot or the control unit also comprising at least one first computer running a servo controller, the method comprising:
-
registering a motion limit for at least one axis of said robot arm, providing a reference signal for a robot position to a robot controller, making a measurement of a position of at least one axis of said robot arm for the purpose of limiting the motion of an arm of said robot, providing a motion limit of said at least one said arm by running in at least one computer a model-based evaluator of a position switch, modelling a position of said at least one axis of said robot arm dependent on said reference signal and comparing the modelled position to the measured position, reading reference or target values sent to the servo control for said at least one axis, reading a measurement value for actual motor position for the at least one axis, and modelling in the model-based evaluator a servo control loop, modelling a gearbox and calculating a first position and a trust value for the first position, wherein a servo loop model for said at least one axis and a model for at least one gearbox is run in the model-based evaluator of the position switch. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18)
-
-
19. A control device for controlling motion of a multi-axis industrial robot or manipulator arranged with a robot control unit, said device comprising:
-
at least one first computer for servo control, a reader configured to read an actual position value and compare the actual position value to a reference signal for the purpose of limiting motion of an arm of said robot in at least one axis, a second computer running a model-based evaluator configured to model with a servo loop model a first position of said at least one axis dependent on said reference signal, compare the modelled first position with a measured position of the at least one axis, and generate a control signal based on a function of the modelled first position, wherein the model-based evaluator comprises an input for inputting a target value sent to the servo control for the at least one axis, and inputting a measurement value for an actual position of the at least one axis, and a servo control loop model, a gearbox model to calculate a first position and a trust value for the first position, and a control signal generator configured to generate a control signal based on the status of the model-based evaluator of at least on axis. - View Dependent Claims (20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 40)
-
-
32. A robot control system for a multi-axis industrial robot or manipulator, the system comprising:
-
a robot control unit, the robot or the control unit also comprising at least one first computer running a servo controller, a registration unit configured to register a motion limit for at least one axis of said robot arm, a reference signal source configured to provide a reference signal for a robot position to a robot controller, a measuring unit configured to make a measurement of a position of at least one axis of said robot arm for the purpose of limiting the motion of said at least one axis of said robot, at least one second computer running a model-based evaluator comprising means for modelling by a servo loop model a first position of the at least one arm dependent on said reference signal, a comparing unit configured to compare the modelled first position with a measured position of said at least one axis, and a control signal generator configured to generate a control signal based on a function of the modelled first position, wherein the model-based evaluator comprises an input for inputting a target value sent to the servo control for the at least one axis, and inputting a measurement value for an actual position of the at least one axis, and a servo control loop model, a gearbox model to calculate a first position and a trust value for the first position, and a control signal generator configured to generate a control signal based on the status of the model-based evaluator of at least on axis. - View Dependent Claims (33, 34, 35, 36, 37, 38, 41)
-
-
39. A computer program, comprising:
-
a non-transitory computer readable medium; and computer program instructions recorded on the computer readable medium and executable by a processor for carrying out a method for controlling motion of a multi-axis industrial robot or manipulator arranged with a robot control unit, the robot or the control unit also comprising at least one first computer running a servo controller, the method comprising; registering a motion limit for at least one axis of said robot arm, providing a reference signal for a robot position to a robot controller, making a measurement of a position of at least one axis of said robot arm for the purpose of limiting the motion of an arm of said robot, providing a motion limit of said at least one said arm by running in at least one computer a model-based evaluator of a position switch, modelling a position of said at least one axis of said robot arm dependent on said reference signal and comparing the modelled position to the measured position, reading reference or target values sent to the servo control for said at least one axis, reading a measurement value for actual motor position for the at least one axis, and modelling in the model-based evaluator a servo control loop, modelling a gearbox and calculating a first position and a trust value for the first position, wherein a servo loop model for said at least one axis and a model for at least one gearbox is run in the model-based evaluator of the position switch.
-
Specification