Abstract:
A method for supervision of the movement control of a manipulator. The manipulator comprises at least one movement axis, a servo (9) for controlling the axis in accordance with supplied reference values for position, speed and acceleration (&psgr;ref, {dot over (&psgr;)}ref, {umlaut over (&psgr;)}ref). A plurality of dynamic parameters (dyn-par) are calculated in dependence on reference values for the position and speed of the axis and a dynamic model (7) which describes the static and dynamic properties of the robot. A torque signal (&tgr;mr) is generated by the servo in dependence on the control error torque (&tgr;err) of the servo. An alarm value (LV) is calculated as a function of the current acceleration ({umlaut over (&psgr;)}m), at least any of the dynamic parameters and one or more of the following signals: the control error torque (&tgr;err) of the servo, the reference value for the acceleration ({umlaut over (&psgr;)}ref) and the torque signal from the servo (&tgr;mr), and while using one or more signal filters. An alarm limit (LG) is calculated as a function of one or more of the following parameters: a constant, the current position (&psgr;m), the current speed ({dot over (&psgr;)}m), the current acceleration ({umlaut over (&psgr;)}m) any of the dynamic parameters, the control error torque (&tgr;err) of the servo, the reference value for the acceleration ({umlaut over (&psgr;)}ref) and the torque signal from the servo (&tgr;mr). The alarm value is compared with the alarm limit and an alarm signal (ALARM) is generated in dependence on the comparison.
Abstract:
A robot control apparatus including a motion torque calculating section for calculating a motion torque command which is required for a motion of a servo motor, a disturbance torque estimating section for calculating a disturbance torque, a minute displacement relationship calculating section for calculating a minute displacement relationship between a task coordinate system of a robot and a joint coordinate system of the servo motor, an external force calculating section for carrying out a conversion to an external force on the task coordinate system, a force control section for calculating a position correction amount on the task coordinate system of the robot, and a joint angle correction amount calculating section for carrying out a conversion to a joint angle correction amount on the joint coordinate system.
Abstract:
A robot control apparatus capable of largely reducing a calculation amount to be capable of lowering a load of a CPU is provided. A control apparatus of a robot includes: a plurality of shafts interfering with each other; each of the shafts including a motor (8), (18), an arm (9), (19) coupled to the motor (8), (18) via a spring element such as a speed reducer and a motor position detector (10), (20) for detecting a position of the motor (8), (18); a position control unit (1), (11) and a speed control unit (2), (12) in order to operate each of the shafts in correspondence with an instruction for each of the plural shafts; an interference force calculating unit (7), (17) for calculating interference force which is exerted to another shaft from an instruction of the own shaft; a non-interference torque signal forming unit (6), (16) for forming a motor torque instruction signal by which the own shaft is operated in correspondence with the instruction also in such a case that interference force exerted from another shaft is present based upon the calculation value of the interference force exerted from another shaft, and the instruction of the own shaft; and a non-interference position signal producing unit (5), (15) for producing a motor position signal by which the own shaft is operated in correspondence with the instruction also in such a case that interference force executed from another shaft is present based upon the calculation value of the interference force exerted from another shaft, and the instruction of the own shaft.
Abstract:
A robot control apparatus including a motion torque calculating section for calculating a motion torque command which is required for a motion of a servo motor, a disturbance torque estimating section for calculating a disturbance torque, a minute displacement relationship calculating section for calculating a minute displacement relationship between a task coordinate system of a robot and a joint coordinate system of the servo motor, an external force calculating section for carrying out a conversion to an external force on the task coordinate system, a force control section for calculating a position correction amount on the task coordinate system of the robot, and a joint angle correction amount calculating section for carrying out a conversion to a joint angle correction amount on the joint coordinate system.
Abstract:
Provided is a medical robot arm apparatus including a plurality of joint units configured to connect a plurality of links and implement at least 6 or more degrees of freedom in driving of a multi-link structure configured with the plurality of links, and a drive control unit configured to control driving of the joint units based on states of the joint units. A front edge unit attached to a front edge of the multi-link structure is at least one medical apparatus.
Abstract:
A robot controller and a robot control method, by which each element constituting a robot is protected. An output of a rotary encoder attached to a servomotor is read, and the motor speed is obtained by calculating the difference between a current speed and another speed in a previous speed loop. Then, a processor of the servo controller of each link of a robot arm executes a normal speed loop control in order to calculate a torque command of the motor. Next, a load torque is estimated by using the obtained torque command and the motor speed, and the estimated load torque in each speed loop is compared with a predetermined threshold. If the load torque is larger than the threshold in at least one of the axes, the robot controller judges that an abnormality has occurred in the robot, generates an alarm or warning, and then controls the robot so as to protect the element.
Abstract:
A robot control apparatus capable of largely reducing a calculation amount to be capable of lowering a load of a CPU is provided. A control apparatus of a robot includes: a plurality of shafts interfering with each other; each of the shafts including a motor (8), (18), an arm (9), (19) coupled to the motor (8), (18) via a spring element such as a speed reducer and a motor position detector (10), (20) for detecting a position of the motor (8), (18); a position control unit (1), (11) and a speed control unit (2), (12) in order to operate each of the shafts in correspondence with an instruction for each of the plural shafts; an interference force calculating unit (7), (17) for calculating interference force which is exerted to another shaft from an instruction of the own shaft; a non-interference torque signal forming unit (6), (16) for forming a motor torque instruction signal by which the own shaft is operated in correspondence with the instruction also in such a case that interference force exerted from another shaft is present based upon the calculation value of the interference force exerted from another shaft, and the instruction of the own shaft; and a non-interference position signal producing unit (5), (15) for producing a motor position signal by which the own shaft is operated in correspondence with the instruction also in such a case that interference force executed from another shaft is present based upon the calculation value of the interference force exerted from another shaft, and the instruction of the own shaft.
Abstract:
Provided is a medical robot arm apparatus including a plurality of joint units configured to connect a plurality of links and implement at least 6 or more degrees of freedom in driving of a multi-link structure configured with the plurality of links, and a drive control unit configured to control driving of the joint units based on states of the joint units. A front edge unit attached to a front edge of the multi-link structure is at least one medical apparatus.
Abstract:
Provided is a surgical imaging apparatus that includes a multi-link, multi joint structure including a plurality of joints that interconnect a plurality of links to provide the multi-link, multi joint structure with a plurality of degrees of freedom, at least one video camera being disposed on a distal end of the multi-link, multi-joint structure; at least one actuator that drives at least one of the plurality of joints; and circuitry that detects a joint force experienced at the at least one of the plurality of joints in response to an applied external force, and controls the at least one actuator based on the joint force so as to position the video camera.
Abstract:
Provided is a medical robot arm apparatus including a plurality of joint units configured to connect a plurality of links and implement at least 6 or more degrees of freedom in driving of a multi-link structure configured with the plurality of links, and a drive control unit configured to control driving of the joint units based on states of the joint units. A front edge unit attached to a front edge of the multi-link structure is at least one medical apparatus.