摘要:
There is provided an actuator control device for force-controlling a joint driving actuator according to a commanded joint force command value τa. The actuator control device includes a joint value detecting means for detecting a joint value q at an output stage of the actuator, an action force detecting means for detecting an action force τe in a joint driving direction at the output stage of the actuator, and a driving force determining means for determining an instructed driving force τ to the actuator, on the basis of an ideal response model of the actuator which specifies the relationship of a joint value acceleration target value achieved as the actuator responds ideally when the joint force command value τa, the action force τe, and a joint value velocity obtained by time-differentiating the joint value q are given.
摘要:
When either a command value or an actually measured value is appropriately selected as an angular velocity used for the frictional torque calculation, the frictional compensation can be made valid at all times in both the case in which a robot is actively operated according to an angular velocity command and the case in which the robot is passively operated being pushed by an external force. In the case where a motor rotating direction and a collision direction are reverse to each other after a collision has been detected, the control mode is switched from the positional control to the electric current control and a torque, the direction of which is reverse to the direction of the motor rotation is generated by the motor, so that the motor rotating speed can be reduced and the collision energy can be alleviated. After that, when the motor rotating speed is reduced to a value not more than the setting value, the control mode is switched to the compliance control and the distortion caused in a reduction gear is dissolved. On the other hand, in the case where the motor rotating direction and the collision direction are the same, the control mode is directly switched from the positional control to the compliance control without passing through the electric current control. When the robot is operated whole following a collision force, the collision force can be alleviated.
摘要:
A robot controller comprises, (1) a servo motor driving a robot manipulator, (2) a motor current detector which detects a current driving the servo motor, (3) a motor rotational speed detector which detects a rotational speed of the servo motor, (4) a disturbance detector which detects a disturbance torque loaded to the robot manipulator by using the motor rotational speed and the motor current, (5) a force control calculator which outputs a force-control-instruction value responsive to a disturbance torque detected by the disturbance detector, and (6) a move restriction calculator which performs a force control by adding a force-control-instruction value to a regular position-instruction value of the robot manipulator. Further, the move restriction calculator switches a force control direction according to a move-restriction-direction-instruction value, and adds the force-control-instruction value to the regular position-instruction value of the robot manipulator so that the force control may move along a restricted direction which has been taught.
摘要:
A failure diagnostic device includes a torque detector that detects disturbance torques applied to joint shafts included in a multi-axis robot, a torque grouping circuit that groups the disturbance torques according to a content of an operation executed by the multi-axis robot upon detection of each disturbance torque, a torque correction circuit that obtains a corrected disturbance torque standardized between a plurality of operations with different contents based on a representative value preliminarily set for each grouped disturbance torque and the disturbance torque detected by the torque detector, and a failure diagnostic circuit that performs a failure diagnosis on the multi-axis robot by comparing the corrected disturbance torque with a threshold.
摘要:
A method according to the invention for controlling a manipulator, in particular of a robot, comprises the step of detecting a contact force between the manipulator and a workpiece (2; 20) on the basis of actual drive forces (t) and drive forces (tModell) of a dynamic model (M d2q/dt2+h(q, dq/dt)=tModell) of the manipulator. The method also comprises at least one of the steps of a) multistage measuring of a position of the workpiece (2) on the basis of detected contact forces (S40, S70), in particular comprising the steps of: determining positions of misaligned contours, in particular edges (2.1, 2.2), of the workpiece (2) by detecting poses of the manipulator and at the same time contact forces acting thereon (S40); moving to reference points of the workpiece (2), in particular defined by recesses (3.1, 3.2, 3.3), on the basis of contours (2.1, 2.2) of the workpiece thus detected (S50); and determining positions of said reference points by detecting contact forces that act on the manipulator upon a movement (S70); and/or b) assembling a workpiece (4, 40) with flexible regulation (S130; S230), wherein an assembled state of the workpiece is monitored on the basis of a detected contact force and/or an end pose of the manipulator reached under the flexible regulation, in particular with the steps: holding the workpiece with the manipulator in at least two force contacts (1.1, 1.2); placing the workpiece in a basic assembly position (FIG. 3A); moving the workpiece into a final assembly position (FIG. 3B) with at least one contact force (1.2) being released; and/or c) non-flexibly regulated movement to a pose (S10; S110; S210); and switching to a flexible regulation on the basis of a detected contact force (S30; S130; S230).
摘要:
A monitoring method for a drive system with a motor and a moving part driven by the motor. The movement of the driven part is monitored and the movement of the driving part is monitored and compared to recognize a collision between the driven part and another structure. Measurement of at least one drive-side motion quantity of the motor is taken and measurement of at least one driven-side motion quantity of the moving part is taken. The motion quantity can be a position, velocity or acceleration. A dynamic model is calculated based on predetermined or expected operational data and the drive side measured data. An error signal is generated when the motion quantity measured on the driven side varies from the dynamic model.
摘要:
When a multiaxial robot with a mechanism having spring elements between electric motors of respective axes and robot arms is controlled, the path precision of a tool tip is increased without causing vibrations produced by mechanical interference between axes and high-frequency vibrations of electric motors. A model controller (1) is supplied with position commands Xref—L, Xref—U with respect to the electric motors and outputs model motor position commands &thgr;Mm—L, &thgr;Mm—U, model motor speed commands {dot over (&thgr;)}Mm—L, {dot over (&thgr;)}Mm—U, and model feed-forward commands UFF—L, UFF—U to feedback controllers (10L, 10U) which actuate and control the electric motors and the robot arms. The model controller (1) includes therein corrective quantity calculators (3L, 3U) for calculating corrective quantities (corrective torques) in view of interfering forces acting between the axes from the other axes to cancel the interfering forces. The model controller (1) outputs the model feed-forward commands with the corrective quantities added thereto.
摘要翻译:当具有在各轴的电动机和机器人臂之间具有弹簧元件的机构的多轴机器人被控制时,刀尖的路径精度增加,而不会引起轴之间的机械干扰和电动机的高频振动产生的振动。 向模型控制器(1)提供相对于电动机的位置指令Xref-L,Xref-U,并输出模型电动机位置指令θMm-L,θMm-U,模型电动机速度指令{dot over(theta)} Mm -L,{dot over(θ)} Mm-U,以及模型前馈命令UFF-L,UFF-U到启动和控制电动机和机器人臂的反馈控制器(10L,10U)。 考虑到作用在来自其他轴的轴之间的干涉力以消除干扰力,模型控制器(1)包括用于计算校正量(校正转矩)的校正量计算器(3L,3U)。 模型控制器(1)输出模型前馈命令与添加的校正量。
摘要:
According to one embodiment, a robot control device is used for a robot arm including a link and a motor for rotationally driving the link. The robot control device includes a derivation part. The derivation part derives a first estimated value including a variation of a rotation angle of the link and a second estimated value including a variation of a rotation angle of the motor, based on an angular velocity and a current reference value of the motor. Furthermore, the derivation part derives an external force generated to the robot arm, based on a difference between the first estimated value and the second estimated value.
摘要:
The invention provides a control device comprising: an actual value obtaining part, obtaining a torque actual value and a velocity actual value, wherein the torque actual value represents a torque generated by the driving source and the velocity actual value represents a velocity of the motion body; an inferring part, which calculates an external force inferred value and a velocity inferred value every other operation period based on the torque actual value by using an operation formula of a predetermined model representing driving of the motion body, wherein the external force inferring value represents an external force generated by the control system; and an output part, evaluating a reliability of the external force inferred value based on the velocity inferred value calculated together if the inferring part calculates the external inferred value, and effectively outputting the external force inferred value when it is judged that there is a designated reliability.
摘要:
A method for controlling a manipulator includes determining by a control device one or more contact force values between the manipulator and a first workpiece. Each of the contact force values is based on an actual driving force of the manipulator and a drive force according to a dynamic model of the manipulator. The method also includes at least one of a) measuring in multiple stages an orientation and location of the first workpiece based on at least one of the one or more determined contact force values or b) joining a second workpiece and the first workpiece under a compliant regulation, where a joining state of the first and second workpieces is monitored based on at least one of an end pose of the manipulator obtained under the compliant regulation, a speed of a temporal change of the manipulator, or at least one of the one or more determined contact force values.