WO2011080856A1 - ロボット、ロボットの制御装置、及び制御方法 - Google Patents
ロボット、ロボットの制御装置、及び制御方法 Download PDFInfo
- Publication number
- WO2011080856A1 WO2011080856A1 PCT/JP2010/006271 JP2010006271W WO2011080856A1 WO 2011080856 A1 WO2011080856 A1 WO 2011080856A1 JP 2010006271 W JP2010006271 W JP 2010006271W WO 2011080856 A1 WO2011080856 A1 WO 2011080856A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- joint
- external force
- robot arm
- movable
- movable state
- Prior art date
Links
Images
Classifications
-
- 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—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/42—Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
- G05B19/423—Teaching successive positions by walk-through, i.e. the tool head or end effector being grasped and guided directly, with or without servo-assistance, to follow a path
-
- 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/36—Nc in input of data, input key till input tape
- G05B2219/36429—Power assisted positioning
-
- 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/39—Robotics, robotics to robotics hand
- G05B2219/39325—External force control, additional loop comparing forces corrects position
Definitions
- the present invention relates to a robot cooperating with a person, such as a robot having a robot arm that performs work support such as power assist in a factory, a home, or a nursing care site, and a control method and control method for the robot.
- an assist conveyance device that provides a limiter for restricting the operating range and transmits a predetermined reaction force to an operator when a conveyed object exceeds the limiter (patent) Reference 1).
- the conventional technique is a method of providing a fixed limiter that restricts the work range of the hand of the robot arm
- the movable range of the hand depends on the relationship of a plurality of joints, such as restriction of the operation range of each joint of the robot arm. It is difficult to apply if it changes complicatedly.
- the conventional technology limits the operation by generating a reaction force by changing a control parameter such as a spring constant for the operation exceeding the limiter.
- a control parameter such as a spring constant for the operation exceeding the limiter.
- the configuration of the control system may be complicated.
- changing the control parameter may cause the control system to become unstable and the robot operation to become unstable.
- An object of the present invention is to solve the problems of the conventional control device, and to realize the restriction of the robot arm operation according to the operation state of the robot arm, such as restriction of the operation range of the joint of the robot arm, with a simple control system structure.
- a robot, a robot control device, and a control method for reducing instability of a control system are provided.
- the present invention is configured as follows.
- an articulated robot arm An external force detecting means disposed on the articulated robot arm and detecting an external force; A joint movable state calculating means for calculating a movable state when the joint of the articulated robot arm is located in any of the movable ranges; The direction in which the robot arm can operate when the external force is applied to the robot arm based on the external state detected by the external force detection unit based on the movable state of the joint calculated by the joint movable state calculation unit An external force conversion means for converting the component into a convertible external force, and By controlling impedance based on the converted external force converted by the external force converting means, the articulated robot arm is controlled so that the movement of the articulated robot arm is limited according to the movable state.
- a robot having a control means.
- a robot control device including an articulated robot arm, A joint movable state calculating means for calculating a movable state when the joint of the articulated robot arm is located in any of the movable ranges; Based on the movable state of the joint calculated by the joint movable state calculating means, the external force detected by the external force detecting means disposed on the articulated robot arm and detecting the external force is used, and the external force is applied to the robot arm.
- An external force conversion means for converting a directional component operable by the robot arm into a conversion external force that can be extracted when applied; By controlling impedance based on the converted external force converted by the external force converting means, the articulated robot arm is controlled so that the movement of the articulated robot arm is limited according to the movable state.
- a control device for a robot characterized in that it has a control means.
- a control method for a robot including an articulated robot arm,
- the joint of the articulated robot arm is located in any of the movable ranges, and the movable state is calculated by the joint movable state calculating means, Based on the calculated movable state of the joint, when the external force is applied to the robot arm, the external force detected by an external force detection unit disposed on the articulated robot arm and detecting an external force is applied to the robot arm.
- a robot control method characterized by the above is provided.
- a control program for a robot including an articulated robot arm, Computer A joint movable state calculating means for calculating a movable state when the joint of the articulated robot arm is located in any of the movable ranges; Based on the movable state of the joint calculated by the joint movable state calculating means, the external force detected by the external force detecting means disposed on the articulated robot arm and detecting the external force is used, and the external force is applied to the robot arm.
- An external force conversion means for converting a directional component operable by the robot arm into a conversion external force that can be extracted when applied; By controlling impedance based on the converted external force converted by the external force converting means, the articulated robot arm is controlled so that the movement of the articulated robot arm is limited according to the movable state.
- a robot control program for functioning as a control means.
- the robot control device by having the joint movable state calculating means and the force converting means, a person can perform an operation that exceeds the joint movable area during the operation by impedance control.
- the joint movement state calculation means it is determined whether the joint is located in any of the movable ranges and is in a movable state, and the converted external force converted by the external force conversion means is used as an input to the impedance calculation means.
- FIG. 1 is a diagram showing an overall configuration of a robot according to a first embodiment of the present invention.
- FIG. 2 is a block diagram showing the configuration of the impedance control means of the robot in the first embodiment of the present invention
- FIG. 3 is a diagram for explaining cooperative transport work with a person by the robot in the first embodiment of the present invention
- FIG. 4 is a diagram showing the relationship between the joint angle q i and the movable state
- FIG. 5 is a flowchart showing overall operation steps of the impedance control means in the robot in the first embodiment of the present invention
- FIG. 6 is a diagram illustrating a constrained curved surface and force conversion in the robot according to the first embodiment of the present invention.
- FIG. 1 is a diagram showing an overall configuration of a robot according to a first embodiment of the present invention.
- FIG. 2 is a block diagram showing the configuration of the impedance control means of the robot in the first embodiment of the present invention
- FIG. 3 is a diagram for explaining cooperative transport work with
- FIG. 7 is a block diagram showing the configuration of the impedance control means of the robot in the second embodiment of the present invention
- FIG. 8 is a diagram showing an overall configuration of the robot in the second embodiment of the present invention
- FIG. 9 is a block diagram showing the configuration of the impedance control means of the robot in the third embodiment of the present invention
- FIG. 10 is a diagram for explaining cooperative transport work with a human by the robot in the third embodiment of the present invention
- FIG. 11 is a diagram showing a specific example of the operation of the robot in the third embodiment of the present invention
- FIG. 12 is a diagram illustrating the relationship between the translational external forces fh and f appearing in the equation (103).
- an articulated robot arm An external force detecting means disposed on the articulated robot arm and detecting an external force;
- a joint movable state calculating means for calculating a movable state when the joint of the multi-joint robot arm is located in any of the movable ranges;
- An external force converting means for converting the component into a convertible external force, By controlling impedance based on the converted external force converted by the external force converting means, the articulated robot arm is controlled so that the movement of the articulated robot arm is limited according to the movable state.
- a robot having a control means.
- the external force conversion means uses the external force detected by the external force detection means as a result of the hand of the articulated robot arm when the joint of the articulated robot arm is fixed.
- a robot according to a first aspect is provided that converts a constrained curved surface that can move as an orthogonal projection onto a tangent plane.
- an external force torque calculating means for calculating an external force torque generated in each joint by the external force applied to the articulated robot arm
- the joint movement state calculation means determines whether the external force torque is a force for returning the operation of each joint of the articulated robot arm from outside the movable area to the movable area based on the calculation result of the external force torque calculating means.
- the control means Does not limit the operation
- the joint movable state calculating means determines that the external force torque is not a force for returning the operation of each joint of the articulated robot arm from outside the movable area to the movable area
- the control means Provides the robot according to the first or second aspect for performing the operation restriction.
- the joint movable state calculating means converts the external force into joint torque, so that the converted external force converted into the joint torque is converted into each joint of the articulated robot arm. Determine whether the force is to return the movement from outside the movable area into the movable area, When the joint movable state calculation means determines that the converted external force is a force that attempts to return the operation of each joint of the articulated robot arm from outside the movable region into the movable region, the control While the means does not perform the operation restriction, When the joint movable state calculation means determines that the converted external force is not a force for returning the operation of each joint of the articulated robot arm from outside the movable region to the movable region, the control The means provides the robot according to the first or second aspect, which performs the operation restriction.
- an operation mode setting unit that sets a movable or fixed operation mode for each joint of the multi-joint robot arm;
- the joint which calculates the movable state based on the operational mode and the movable state of the joint calculated by the joint movable state calculating means when the operational mode command set by the operational mode setting unit is input.
- the external force conversion means is configured to apply the external force detected by the external force detection means based on the movable state of the joint calculated by the joint operation mode setting means when the external force is applied to the robot arm.
- the control unit according to any one of the first to fourth aspects, in which operation control is performed according to the movable state of the joint of the articulated robot arm by performing impedance control based on the converted external force.
- operation control is performed according to the movable state of the joint of the articulated robot arm by performing impedance control based on the converted external force.
- the joint movable state calculation means provides a buffer area inside a certain range from a boundary line between both ends of the joint movable area, and the movable area of the joint is provided in each buffer area.
- the robot according to the third or fourth aspect in which the state is gradually changed is provided.
- a fully movable region is a buffer region provided inside both ends of the joint movable region of the articulated robot arm, and a remaining region of the movable region excluding the buffer region.
- the joint movable state calculation means provides the robot according to the first aspect, which is calculated so as to vary the value of the movable state of the joint for each region.
- the joint movable state calculating means and the force converting means are provided as second control means separately from the control means of the articulated arm,
- the robot according to the first aspect in which an external force converted by the force conversion unit is input to the control unit through communication from the second control unit.
- a robot control device including an articulated robot arm, A joint movable state calculating means for calculating a movable state when the joint of the articulated robot arm is located in any of the movable ranges; Based on the movable state of the joint calculated by the joint movable state calculating means, the external force detected by the external force detecting means disposed on the articulated robot arm and detecting the external force is used, and the external force is applied to the robot arm.
- An external force conversion means for converting a directional component operable by the robot arm into a conversion external force that can be extracted when applied; By controlling impedance based on the converted external force converted by the external force converting means, the articulated robot arm is controlled so that the movement of the articulated robot arm is limited according to the movable state.
- a control device for a robot characterized in that it has a control means.
- a control method for a robot including an articulated robot arm,
- the joint of the articulated robot arm is located in any of the movable ranges, and the movable state is calculated by the joint movable state calculating means, Based on the calculated movable state of the joint, when the external force is applied to the robot arm, the external force detected by an external force detection unit disposed on the articulated robot arm and detecting an external force is applied to the robot arm.
- a robot control method characterized by the above is provided.
- a control program for a robot including an articulated robot arm, Computer A joint movable state calculating means for calculating a movable state when the joint of the articulated robot arm is located in any of the movable ranges; Based on the movable state of the joint calculated by the joint movable state calculating means, the external force detected by the external force detecting means disposed on the articulated robot arm and detecting the external force is used, and the external force is applied to the robot arm.
- An external force conversion means for converting a directional component operable by the robot arm into a conversion external force that can be extracted when applied; By controlling impedance based on the converted external force converted by the external force converting means, the articulated robot arm is controlled so that the movement of the articulated robot arm is limited according to the movable state.
- a robot control program for functioning as a control means.
- FIG. 1 is a diagram showing the configuration of the robot 90 according to the first embodiment of the present invention.
- the robot 90 includes an articulated robot arm 5 and a control device 1 that controls the operation of the articulated robot arm 5.
- the control device 1 is composed of a general personal computer in terms of hardware.
- the portion of the impedance control means (impedance control unit) 4 excluding the input / output IF 19 is realized by software as a control program 17 executed by a personal computer.
- the input / output IF 19 includes a D / A board 20, an A / D board 21, and a counter board 22 connected to an expansion throttle such as a PCI bus of a personal computer.
- the control device 1 functions by executing the control program 17 for controlling the operation of the articulated robot arm 5 of the robot 90.
- the joint angle information output from the encoders 42 of the joints 11, 12, 13, 14, 15, 16 of the robot arm 5 is taken into the control device 1 through the counter board 22, and the joints 11, 12 are controlled by the control device 1.
- 13, 14, 15, and 16 are calculated control command values.
- the calculated control command values are given to the motor driver 18 through the D / A board 20, and the joints 11, 12, 13, 14, 15 of the robot arm 5 according to the control command values sent from the motor driver 18.
- 16 motors 41 are driven.
- the robot arm 5 is a multi-link manipulator having 6 degrees of freedom, and a hand 6 functioning as an example of a hand, a forearm link 8 having a wrist portion 7 to which the hand 6 is attached, and the forearm link 8 are rotatably connected.
- the upper arm link 9 has a base portion 10 on which the upper arm link 9 is rotatably connected and supported.
- the wrist portion 7 has three rotation axes of the fourth joint 14, the fifth joint 15, and the sixth joint 16, and changes the relative posture (direction) of the hand 6 with respect to the upper arm link 9. be able to.
- the other end of the forearm link 8 can rotate around the third joint 13 with respect to one end of the upper arm link 9, and the other end of the upper arm link 9 can rotate around the second joint 12 with respect to the base 10.
- the upper movable part 10a of the base part can rotate around the first joint 11 with respect to the lower fixed part 10b of the base part, and can rotate around a total of six axes to constitute the multi-link manipulator with six degrees of freedom. is doing.
- Each joint 11, 12, 13, 14, 15, 16 constituting the rotating part of each shaft is a rotary drive device (this first part) provided on one member of each joint 11, 12, 13, 14, 15, 16.
- a motor 41) and an encoder 42 for detecting the rotational phase angle (ie, joint angle) of the rotating shaft of the motor 41 are provided. Then, the rotation shaft of the motor 41 is connected to the other member of the joint and rotates the rotation shaft in the forward and reverse directions, so that the other member can be rotated around each shaft with respect to the one member.
- the rotation drive device is driven and controlled by a motor driver 18 described later.
- a motor 41 and an encoder 42 as an example of a rotary drive device are disposed inside each joint 11, 12, 13, 14, 15, 16 of the robot arm 5.
- Reference numeral 35 denotes an absolute coordinate system in which the relative positional relationship is fixed with respect to the lower fixed portion 10 b of the base unit 10, and reference numeral 36 denotes a hand coordinate system in which the relative positional relationship with respect to the hand 6 is fixed.
- the origin position O e (x, y, z) of the hand coordinate system 36 viewed from the absolute coordinate system 35 is set as the hand position of the robot arm 5, and the posture of the hand coordinate system 36 viewed from the absolute coordinate system 35 is set to roll, pitch,
- a force sensor 3 that functions as an example of an external force detection means (an external force detection unit or an external force detection device) is disposed between the wrist 7 and the hand 6 of the robot arm 5 so that the external force applied to the hand 6 can be detected. .
- 5 is the robot arm shown in FIG.
- q 1 , q 2 , q 3 , q 4 , q 5 and q 6 are respectively the first joint 11, the second joint 12, the third joint 13, the fourth joint 14, the fifth joint 15, and the sixth joint. This is the joint angle of the joint 16.
- Target track generation unit (target trajectory generation unit) 23 outputs the hand position and orientation target vector r d for realizing the operation of the robot arm 5 to a target.
- the position (r d0 , r d1 , r d2 ,...) For each point is given as time series data in advance according to the target work.
- Target trajectory generation section 23 uses a polynomial interpolation, to complement the trajectory between points, to generate a hand position and orientation target vectors r d.
- the impedance calculation means (impedance calculation section) 25 is a part that fulfills the function of realizing the mechanical impedance in the robot arm 5, and operates independently by position control so that the robot arm 5 follows the target trajectory generated by the target trajectory generation means 23. If it does, 0 is output.
- the impedance calculation means 25 (i) set impedance parameters M, D, K (inertia M, viscosity D, rigidity K), and (iii) the conversion external force F h which converts the external force F inputted to the impedance control unit 4 (gravity compensation means 30 of the impedance control unit 4), the hand position for realizing the mechanical impedance to the robot arm 5 and orientation target correcting output r d ⁇ is calculated by the following equation (1) and output.
- Hand position and orientation target correcting output r d It is added by the first calculation unit 61 to output to the hand position and orientation target r d of the target trajectory generation section 23, the hand position and orientation correction target vector r dm is generated.
- the forward kinematics calculation means 26 receives a joint angle vector q which is a current value q of each joint angle output from the robot arm 5 and converts the joint angle vector q of the robot arm 5 into a hand position / posture vector r. Perform a geometrical calculation.
- Error r e obtained by the second operation unit 62 is inputted to the positional error compensating unit 27, the position error compensation output u rp is obtained by the positional error compensating unit 27 is output to the approximate inverse kinematic calculation means 28 .
- the approximate inverse kinematics calculation means 28 is an approximate expression Is used to approximate the inverse kinematics.
- J r (q) is A Jacobian matrix satisfying the relationship: u in is an input to the approximate inverse kinematics calculation means 28, and u out is an output from the approximate inverse kinematics calculation means 28.
- u in is an input to the approximate inverse kinematics calculation means 28
- u out is an output from the approximate inverse kinematics calculation means 28.
- the joint angle error compensation output u qe is given as a voltage command value from the approximate inverse kinematics calculation means 28 to the motor driver 18 via the D / A board 20, and each joint axis is driven to rotate forward and reverse so that the robot arm 5 is rotated. Operate.
- the basic operation is the position error compensation means 27 by the hand position and orientation feedback control of the error r e (position control), is a portion surrounded by a dotted line in FIG. 2 has a position control system 29.
- the position error compensation means 27 for example, by using the PID compensator acts is controlled to the hand position and orientation error r e is converged to 0, the operation of the robot arm 5 to the target is realized.
- the hand position / posture target correction output rd ⁇ is added by the impedance calculation means 25 to the position control system 29 described above by the first calculation unit 61 to correct the hand position / posture target value. Done. For this reason, in the position control system 29 described above, the target value of the hand position / posture slightly deviates from the original value, and as a result, mechanical impedance is realized.
- the portion surrounded by the one-dot chain line in FIG. 2 has a configuration called a position control based impedance control system 49, and the impedance control system 49 realizes mechanical impedance of inertia M, viscosity D, and rigidity K.
- the impedance control unit 4 functions as an example of a control unit (control unit) (or operation control unit or operation control unit).
- a collaborative work such as the coordinated conveyance of the person 100 and the object 38 of the robot 90 as shown in FIG. 3 becomes possible.
- the force is transmitted to the robot arm 5 of the robot 90 through the object 38, and the force is detected as an external force F s by the force sensor 3 of the robot arm 5.
- the external force F that is input to the impedance control means 4 is calculated by the equation (5) based on the external force F s detected by the force sensor 3 in the gravity compensation means 30 in order to compensate for the gravity of the object 38 that is cooperatively conveyed. And use the calculated F.
- m is the mass of the object 38
- g is the gravitational acceleration of the object 38.
- the feature of the robot control device 1 according to the first embodiment of the present invention is that it has a joint movable state calculation means 2 and a force conversion means 24 in addition to the basic configuration of the impedance control means 4 described above. Details of the joint movable state calculating means 2 and the force converting means 24 will be described.
- the joint movable state calculating means 2 determines the movable state of each joint 11, 12, 13, 14, 15, 16 by inputting the current value (joint angle vector) q of the joint angle of the robot arm 5 (specifically Specifically, each of the first to sixth joints 11, 12, 13, 14, 15, 16 or at least one joint is located in any of the movable ranges to calculate the movable state), and the determination result
- the (calculation result) is output to the force conversion means (force conversion section, external force conversion means, or external force conversion section) 24.
- the joint movable state calculation means 2 calculates the movable region MR and the movable region based on the minimum value q iMIN and the maximum value q iMAX of the movable range of each joint 11, 12, 13, 14, 15, 16 and the buffer region width dq i.
- a first buffer region BR1 and a second buffer region BR2 that are disposed inward by a certain range from the boundary lines at both ends of the MR are defined.
- Each of the first buffer region BR1 and the second buffer region BR2 is a region that gradually changes the movable state of the joint. Then, the joint movable state calculation means 2 divides the pattern according to the region to which the current joint angle q i belongs, and sets the movable state L i of each joint 11, 12, 13, 14, 15, 16 between 0 and 1. Calculate as the value of.
- the impedance control means 4 is provided with an external force torque calculation means 50 for calculating an external force torque ⁇ generated at each joint by an external force F applied to the multi-joint robot arm 5.
- torque ⁇ [ ⁇ 1 , ⁇ 2 , ⁇ 3 , ⁇ generated in each joint 11, 12, 13, 14, 15, 16 by the external force F according to Equation (6). 4 , ⁇ 5 , ⁇ 6 ] T is calculated.
- the joint movable state calculating means 2 when each joint 11, 12, 13, 14, 15, 16 is in the buffer area BR 1, BR 2 or outside the movable area, it is calculated by the external force torque calculating means 50.
- Jv is Jacobian matrix that satisfies the relationship so, Is the rotational speed of the hand of the robot arm 5.
- the specific value of the offset value dL i is determined experimentally in advance by actually operating the robot arm 5 in consideration of the ease of operation or the stability of control, and the joint movable state calculating means 2 It will be stored in.
- the offset value dL i is generated at the boundary of the movable region MR, as will be described later, by determining the reaction of the joint i with respect to the torque to return the joint i into the movable region MR by the joint movable state calculation means 2.
- This value determines the degree of occurrence of a phenomenon such as a limit cycle. Specifically, the greater the offset value dL i , the better the response to the force to return to the movable region MR and the easier the operation, while the larger the offset value dL i , the more like a limit cycle. The instability increases due to the phenomenon.
- the specific value of the offset value dL i is determined experimentally in advance by actually operating the robot arm 5 in consideration of the operability and the control stability resulting from the above-mentioned contradictory good reactions. It is stored in the joint movable state calculation means 2.
- “Ease of operation” here means that the smaller the value of the offset value dLi, the more the force is applied, the more it will not return, so the operability is worse, whereas the larger the value of the offset value dLi, the smaller the value. Because it can be easily returned by force, it is said to have good operability.
- a phenomenon such as a limit cycle occurs. Specifically, vibration occurs and control becomes unstable. That is, “control stability” here means that vibration is generated due to control and the motion is not stable.
- the first conversion method is a conversion method based on the following equations (7) to (13).
- j 1 , j 2 , and j 3 are three-dimensional vectors that satisfy Equation (13), and the 3 ⁇ 3 matrix [j 1 j 2 j 3 ] is This corresponds to a 3 ⁇ 3 submatrix in the upper left of the Jacobian matrix J r (q) that satisfies the above relationship.
- the second conversion method is a method of pattern classification according to patterns A to E, which is a pattern classification of the joint movable state.
- Pattern ⁇ When all of the joint angles q 1 , q 2 , q 3 are the pattern A, . . . . (101) It becomes.
- Pattern ⁇ When any one of the joint angles q 1 , q 2 , q 3 is any of the patterns B to E (that is, the other two joints having the joint angles q 1 , q 2 , q 3 ) Angle q is pattern A), For example, if the joint angle q i is one of the patterns B to E and the joint angles q a and q b are the pattern A (in this example, q i is q 1 , q 2 , q 3 And q a and q b mean the other two joint angles of the joint angles q 1 , q 2 , and q 3 ).
- Pattern ⁇ When any two joint angles q of the joint angles q 1 , q 2 , q 3 are any of the patterns B to E (that is, the remaining one joint of the joint angles q 1 , q 2 , q 3 ) Angle q is pattern A), For example, if the joint angle q i is the pattern A and the joint angles q a and q b are any of the patterns B to E (however, in this example, q i is the joint angles q 1 , q 2 and q 3 means one joint angle, and q a and q b mean the other two joint angles of joint angles q 1 , q 2 , and q 3 ). . . . . (103) It becomes.
- Pattern ⁇ When all of the joint angles q 1 , q 2 , q 3 are any of the patterns B to E, . . . . (104) It becomes.
- the first conversion method has the advantage that it is not necessary to divide the pattern of conversion formulas and can be a simple algorithm.
- the second joint 12 and the third joint 13 of the robot arm 5 shown in FIG. In the case of an arm structure having parallel joint axes as described above, it cannot be dealt with only when joints with parallel joint axes are simultaneously outside the fully movable region.
- the second conversion method needs to be divided into patterns of conversion formulas, but can be applied to any case including a case where a plurality of joints are outside the fully movable region regardless of the structure of the arm.
- the force conversion means 24 may be set in advance so that the first conversion method and the second conversion method are selected according to the structure of the arm or the size of the movable range of each joint. .
- FIG. 5 is a flowchart for explaining operation steps during impedance control by a control program based on the above-described principle.
- step S1 joint angle data (joint angle vector q) measured by the encoder 42 is taken into the control device 1.
- step S 2 calculation of the Jacobian matrix J r and the like necessary for kinematic calculation of the robot arm 5 is performed by the approximate inverse kinematic calculation means 28.
- step S3 the current hand position / posture vector r of the robot arm 5 is calculated by the forward kinematics calculation means 26 from the joint angle data (joint angle vector q) from the robot arm 5 (forward kinematics calculation means 26). Processing).
- step S4 the joint movable state calculating means 2 determines which of patterns A to E is based on the joint angle data (joint angle vector q) from the robot arm 5, and determines the joint movable state Li . calculate.
- step S5 the measurement value F s of the force sensor 3 is taken into the gravity compensation means 30, the external force F based on the equation (5) is calculated by the gravity compensation means 30.
- step S6 in the force conversion means 24, the expressions (7) to (13) (first conversion method), the expressions (7), (11), (12), and (101) to (101) (104) based on (second conversion method), the calculated external force F is converted into converted external force F h gravity compensation means 30.
- step S 7 the hand position / posture target correction output r d ⁇ is calculated from the mechanical impedance parameters M, D, K, the joint angle data (joint angle vector q), and the converted external force F h converted by the force conversion means 24. , Calculated by the impedance calculation means 25 (processing in the impedance calculation means 25).
- step S8 the hand position and orientation target vector r d and the hand position and posture target correcting output r d? Sum hand position and orientation correction obtained is calculated by the first calculation unit 61 of the target vector r dm, current
- the hand position / posture error r e which is the difference from the hand position / posture vector r, is calculated by the second calculation unit 62 (processing by the position error compensation means 27).
- a PID compensator can be considered. Control is performed so that the position error converges to 0 by appropriately adjusting three gains of proportionality, differentiation, and integration, which are constant diagonal matrices.
- step S9 by multiplying the inverse matrix of the Jacobian matrix J r calculated in step S2, the positional error compensating output u re from the value relating to the error of the hand position and orientation, the joint angle error is a value related to the error of the joint angle
- the compensation output u qe is converted by the approximate inverse kinematics calculation means 28 (processing by the approximate inverse kinematics calculation means 28).
- step S10 the joint angle error compensation output u qe is given from the approximate inverse kinematics calculation means 28 to the motor driver 18 through the D / A board 20, and the amount of current flowing through each motor 41 is changed to change the robot arm 5's. A rotational movement of the joint axis of each joint occurs.
- Control of the operation of the robot arm 5 is realized by repeatedly executing the above steps S1 to S10 as a control calculation loop. Note that the order of the operations in steps S2 to S6 may be parallel processing, and does not necessarily have to be in this order.
- the robot 90 includes the joint movable state calculation means 2 and the force conversion means 24, thereby realizing operations and effects as described in detail below.
- the operation when the person 100 and the robot 90 perform coordinated conveyance will be described with a focus on the third joint 13.
- FIG. 6 shows the relationship between the translational external forces f h and f h2 that appear in Equation (8).
- the first joint 11 to the third joint 13 of the robot arm 5 are schematically shown.
- the restraint curved surface 31 moves the other first joint 11 and the second joint 12 to move the hand of the robot arm 5.
- This is a curved surface on which the hand 6 can move.
- the constrained curved surface 31 is actually a spherical surface, but in FIG. 6, only a circle of a certain cross section is drawn. That is, when the third joint 13 is locked, the hand of the robot arm 5 is restrained by the restraining curved surface 31.
- a plane that is in contact with the constrained curved surface 31 and that passes through the hand of the robot arm 5 is a tangential plane 32.
- the tangential plane 32 is a plane parallel to the plane including the vectors j 1 and j 2 .
- An orthographic projection of the translational external force f h2 onto the tangential plane 32 is f hC .
- the orthogonal projection f hC is a translational external force f h when the movable state L 3 of the third joint 13 is 0 in the equation (8), and is represented by the equation (14).
- equation (14) is a portion surrounded by “ ⁇ ” and “ ⁇ ” in equation (8)
- equation (8) to calculate the conversion external force F h is an orthogonal projection. You are using a transformation.
- the conversion to orthographic projection is not limited to formula (8), but the portions surrounded by “ ⁇ ” and “ ⁇ ” in formula (9) and formula (10) are also converted to orthographic projection. You will be using the conversion.
- the orthogonal projection f hC is an example of the converted external force F h . That is, when an orthogonal projection of the constrained curved surface 31 onto the tangent plane 32 is considered, it becomes a direction component in which the robot arm 5 can operate.
- the buffer regions BR1 and BR2 play a role of stabilizing the operation by gradually restricting the operation.
- the input to the impedance calculation unit 25 will change in a stepped manner to the translational external force f hC from translational external force f h2, the control system That is, the impedance control means 4 tends to become unstable.
- pattern B relates to the first buffer region BR1
- pattern C pattern C1 of the second buffer region BR2, which is the region on the opposite side of the pattern A from the first buffer region BR1.
- Pattern C2 the description is omitted.
- the pattern D (pattern D1, pattern D2) relates to the outside of the movable region of the first buffer region BR1, and is outside the movable region of the second buffer region BR2, which is the region opposite to the first buffer region BR1 of the pattern A. Since this is the same as the pattern E (pattern E1, pattern E2) of FIG.
- FIG. 12 shows the relationship between the translational external forces f h and f appearing in the equation (103).
- the first joint 11 to the third joint 13 of the robot arm 5 are schematically shown.
- the restraint curve 201 indicates that the remaining first joint 11 moves and the hand of the robot arm 5 moves. It is a curve which the hand 6 of this can move. That is, when the second joint 12 and the third joint 13 are locked, the hand of the robot arm 5 is restrained by the restraint curve 201.
- a tangent line of the constraint curve 201 and a straight line passing through the hand of the robot arm 5 is a tangent line 202. Also, the tangent 202 is a straight line parallel to the vector j 1.
- An orthographic projection of the translational external force f onto the tangent 202 is f hc .
- the posture ( ⁇ , ⁇ , ⁇ ) of the hand of the robot arm 5 is determined based on the joint movable states L 4 , L 5 , L 6.
- the movement limitation of the fourth joint 14, the fifth joint 15, and the sixth joint 16 that is the wrist portion 7 is realized.
- the joint movable state calculating unit 2 and the force converting unit 24 a person performs an operation that exceeds the movable region MR of the joint of the robot arm 5 during the operation by the impedance control. Also, it is judged movable state of the joint in the joint motion state calculation means 2, by using the conversion external force F h which is converted by the force converting means 24 as an input to the impedance calculation unit 25, the operation limit of the robot arm 5 It is possible to prevent the joint movable region MR from being exceeded.
- the first embodiment performs the operation restriction by applying a conversion by the force converting means 24 to the input to the impedance calculation unit 25, i.e., to limit the input from the external force F to the conversion force F h Therefore, even when the robot arm 5 cannot move beyond the mechanical movable region MR of the robot arm 5, the input continues to be input to the impedance calculation means 25, and the impedance calculation means 25 or position control in the subsequent stage. An error is not accumulated in the system 29, and an extraordinary effect that a stable control system can be achieved is exhibited.
- the operation is not limited by changing the impedance parameter for impedance control, a mechanism for changing the parameter is unnecessary, and the structure of the control system can be simplified. Furthermore, it is possible to prevent the control system from becoming unstable due to parameter changes. That, in the first embodiment, by performing the input limit by the force converting means 24 (in other words, to use the converted external force F h the external force F is converted by the force converting means 24 as an input to the impedance calculation unit 25) Thus, since the excellent effect can be exhibited, it is not necessary to change the impedance parameter.
- each joint is restricted independently. Therefore, even if a certain joint is restricted, other operable joints can continue to move without being restricted. As a result, it is possible to provide a robot with good operability that is immediately limited in operation and does not stop.
- normal impedance control means 43 that is, impedance calculation means 25, target trajectory generation means 23, forward kinematics calculation means 26, position error compensation means 27, approximate inverse kinematics.
- the joint movement state calculation means 2 and the force conversion means 24 are arranged in the force input control means 34 independent of the calculation means 28, the first calculation part 61, and the second calculation part 62), and an existing control device (first 1 control device) 1B.
- FIG. 8 shows the overall configuration of the robot 90B of the second embodiment, and shows the specific configuration of the control device.
- a second control device 46 is added separately from the first control device 1B, and is configured by two independent control devices 1B and 46.
- the second control device 46 is configured by a general personal computer in terms of hardware.
- the parts other than the input / output IF (D / A board 45, A / D board 47, and counter board 48) implement the force input control means 34 by the control program 44 executed by the personal computer.
- the force input control means 34 receives the external force F s from the force sensor 3 through the A / D board 47, and the converted external force F h that is a conversion result by the force conversion means 24 passes through the D / A board 45 to the first controller 1 ⁇ / b> B. Is output to the A / D board 21 which is the force sensor input, and is taken into the first control device 1B through the A / D board 21. In this way, by connecting the D / A board 45 and the A / D board 21, a communication unit that transmits the converted external force F h by the voltage value is configured.
- the force input control means 34 acquires joint angle information output from the encoder 42 of each joint portion of the robot arm 5 through the counter board 48, and the joints 11, 12, 13, 14, It is used as information for determining the movable states 15 and 16.
- the impedance control means 4 is realized by one control program 17 operating on one control device (PC) 1 as shown in FIG. 1, but the second embodiment is shown in FIG. As described above, the second control device 46 is added to the first control device 1B, and a configuration for communicating with the existing first control device 1B becomes possible.
- the operation of the robot arm 5 can be limited only by adding the second controller 46 in order to process an input signal from a force sensor of a commercially available robot controller.
- FIG. 9 is a block diagram showing the configuration of the impedance control means of the robot 90C according to the third embodiment of the present invention
- FIG. 10 is a diagram for explaining cooperative transport work with the person 100 by the robot 90C.
- the operation handle 40 is fixed to the wrist portion 7 via the force sensor 3, and the person 100 directly grips the operation handle 40 and applies force to the robot 90 ⁇ / b> C. 90C can be operated.
- the force sensor 3 is disposed between the operation handle 40 and the robot arm 5, and the force when the person 100 operates can be detected by the force sensor 3.
- the operation handle 40 is provided with an operation mode setting switch 39 as an example of an operation mode setting unit, and the person 100 operates the operation mode setting switch 39 that functions as an example of an operation mode input unit.
- the operation mode (movable or fixed mode) can be set and switched.
- an operation mode command is input from the operation mode setting switch 39 to the joint operation mode setting means 37.
- the joint movable state calculation means 2 inputs the joint movable state Li to the joint operation mode setting means 37, and the force conversion means 24 outputs the extended joint movable state Lim .
- the robot arm 5 takes charge of all loads of the object 38, so that the gravity compensation means 30 is unnecessary.
- the measurement value F s of the force sensor 3 is input as an external force F to the force conversion means 24 and converted into a converted external force F h .
- the movable or fixed mode of each of the six joints 11, 12, 13, 14, 15, 16 of the robot arm 5 can be set.
- These extended joint movable states L im are handled in the same manner as the movable state L i described in the first embodiment, and are input to the conversion means 24 for use. As a result, the joint set in the fixed mode is fixed with its operation restricted by the principle described in the first embodiment.
- the joint operation mode setting means 37 by having the joint operation mode setting means 37, an operation of fixing a specific joint or an operation of rotating only a specific joint can be easily performed. Therefore, the robot can be more easily operated.
- the first joint 11 when only the first joint 11 is rotated and the robot arm 5 is rotated with respect to the base unit 10, If the first joint 11 is set to be movable by the mode setting switch 39 and the second to sixth joints 12 to 16 are set to be fixed, the first joint of the robot arm 5 can be obtained simply by the person 100 applying force to the operation handle 40. It is possible to realize a turning operation in which only 11 is easily rotated.
- the robot, the robot control device, and the control method of the present invention realize the control of the robot arm operation according to the operation state of the joint, such as restriction of the operation range of the joint of the robot arm, with a simple control system structure.
- System instability can be reduced, and it is useful as a robot that cooperates with humans, such as robots that support work assistance such as power assist in factories, homes, nursing care sites, etc., robot control devices, and control methods It is.
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
Description
前記多関節ロボットアームに配設され、かつ、外力を検出する外力検出手段と、
前記多関節ロボットアームの関節が可動範囲のいずれかに位置して可動状態を計算する関節可動状態計算手段と、
前記関節可動状態計算手段により計算された前記関節の前記可動状態に基づき、前記外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に変換する外力変換手段と、
前記外力変換手段により変換された前記変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われるように前記多関節ロボットアームを制御する制御手段とを有するロボットを提供する。
前記多関節ロボットアームの関節が可動範囲のいずれかに位置して可動状態を計算する関節可動状態計算手段と、
前記関節可動状態計算手段により計算された前記関節の前記可動状態に基づき、前記多関節ロボットアームに配設されて外力を検出する外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に変換する外力変換手段と、
前記外力変換手段により変換された前記変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われるように前記多関節ロボットアームを制御する制御手段とを有することを特徴とするロボットの制御装置を提供する。
前記多関節ロボットアームの関節が可動範囲のいずれかに位置して可動状態を関節可動状態計算手段で計算し、
前記計算された前記関節の前記可動状態に基づき、前記多関節ロボットアームに配設されて外力を検出する外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に外力変換手段で変換し、
前記変換された変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われるように前記多関節ロボットアームを制御手段で制御することを特徴とするロボットの制御方法を提供する。
コンピュータを、
前記多関節ロボットアームの関節が可動範囲のいずれかに位置して可動状態を計算する関節可動状態計算手段と、
前記関節可動状態計算手段により計算された前記関節の前記可動状態に基づき、前記多関節ロボットアームに配設されて外力を検出する外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に変換する外力変換手段と、
前記外力変換手段により変換された前記変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われるように前記多関節ロボットアームを制御する制御手段として機能させるためのロボットの制御プログラムを提供する。
前記多関節ロボットアームに配設され、かつ、外力を検出する外力検出手段と、
前記多関節ロボットアームの関節が可動範囲のいずれかに位置して可動状態を計算する関節可動状態計算手段と、
前記関節可動状態計算手段により計算された前記関節の前記可動状態に基づき、前記外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に変換する外力変換手段と、
前記外力変換手段により変換された前記変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われるように前記多関節ロボットアームを制御する制御手段とを有するロボットを提供する。
前記関節可動状態計算手段は、前記外力トルク計算手段の計算結果に基づき前記外力トルクが前記多関節ロボットアームの各関節の動作を可動領域外より可動領域内に戻そうとする力であるかどうかを判定し、
前記関節可動状態計算手段が、前記外力トルクが前記多関節ロボットアームの各関節の動作を前記可動領域外より前記可動領域内に戻そうとする力であると判定する場合には、前記制御手段は前記動作制限を行わない一方、
前記関節可動状態計算手段が、前記外力トルクが前記多関節ロボットアームの各関節の動作を前記可動領域外より前記可動領域内に戻そうとする力ではないと判定する場合には、前記制御手段は前記動作制限を行う第1又は2の態様に記載のロボットを提供する。
前記関節可動状態計算手段が、前記変換外力が、前記多関節ロボットアームの各関節の動作を前記可動領域外より前記可動領域内に戻そうとする力であると判定する場合には、前記制御手段は前記動作制限を行わない一方、
前記関節可動状態計算手段が、前記変換外力が、前記多関節ロボットアームの各関節の動作を前記可動領域外より前記可動領域内に戻そうとする力ではないと判定する場合には、前記制御手段は前記動作制限を行う第1又は2の態様に記載のロボットを提供する。
前記動作モード設定部で設定された前記動作モードの指令が入力されて、前記動作モードと前記関節可動状態計算手段により計算された前記関節の前記可動状態とに基づき前記可動状態の計算を行う関節動作モード設定手段とをさらに備えて、
前記外力変換手段は、前記関節動作モード設定手段により計算された前記関節の前記可動状態に基づき、前記外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に変換し、
前記制御手段は、前記変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われる第1~4のいずれか1つの態様に記載のロボットを提供する。
前記関節可動状態計算手段は、各領域毎に、前記関節の前記可動状態の値を異ならせるように計算される第1の態様に記載のロボットを提供する。
前記力変換手段が変換した外力が前記第2制御手段より通信を通じて前記制御手段に入力される第1の態様に記載のロボットを提供する。
前記多関節ロボットアームの関節が可動範囲のいずれかに位置して可動状態を計算する関節可動状態計算手段と、
前記関節可動状態計算手段により計算された前記関節の前記可動状態に基づき、前記多関節ロボットアームに配設されて外力を検出する外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に変換する外力変換手段と、
前記外力変換手段により変換された前記変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われるように前記多関節ロボットアームを制御する制御手段とを有することを特徴とするロボットの制御装置を提供する。
前記多関節ロボットアームの関節が可動範囲のいずれかに位置して可動状態を関節可動状態計算手段で計算し、
前記計算された前記関節の前記可動状態に基づき、前記多関節ロボットアームに配設されて外力を検出する外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に外力変換手段で変換し、
前記変換された変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われるように前記多関節ロボットアームを制御手段で制御することを特徴とするロボットの制御方法を提供する。
コンピュータを、
前記多関節ロボットアームの関節が可動範囲のいずれかに位置して可動状態を計算する関節可動状態計算手段と、
前記関節可動状態計算手段により計算された前記関節の前記可動状態に基づき、前記多関節ロボットアームに配設されて外力を検出する外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に変換する外力変換手段と、
前記外力変換手段により変換された前記変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われるように前記多関節ロボットアームを制御する制御手段として機能させるためのロボットの制御プログラムを提供する。
図1は本発明の第1実施形態のロボット90の構成を示す図である。ロボット90は、多関節ロボットアーム5と、多関節ロボットアーム5の動作を制御する制御装置1とを備えて構成されている。
ただし、mは物体38の質量、gは物体38の重力加速度である。式(5)で計算される外力Fを入力にインピーダンス制御を行えば、ロボットアーム5は人100がかけた力の方向に沿うように動作するため、協調搬送が実現する。なお、物体38の質量m、及び、物体38の重力加速度gは、重力補償手段30に予め記憶されている。
パターンB: (qiMIN)<qi<(qiMIN+dqi):すなわち、(第1緩衝領域BR1内)のとき:
パターンB1: τi≦0の場合: Li=(qi-qiMIN)/dqi
パターンB2: τi>0の場合: Li=(qi-qiMIN)/dqi+dLi
(ただし、 Li≦1に制限)
パターンC: (qiMAX-dqi)<qi<(qiMAX):すなわち、(第2緩衝領域BR2内)のとき:
パターンC1: τi≧0の場合: Li=(qiMAX-qi)/dqi
パターンC2: τi<0の場合: Li=(qiMAX-qi)/dqi+dLi
(ただし、 Li≦1に制限)
パターンD: qi≦qiMIN:すなわち、(可動領域外)のとき:
パターンD1: τi≦0の場合: Li=0
パターンD2: τi>0の場合: Li=dLi
パターンE: qiMAX≦qi:すなわち、(可動領域外)のとき:
パターンE1: τi≧0の場合: Li=0
パターンE2: τi<0の場合: Li=dLi
力変換手段24は、関節可動状態計算手段2の出力である可動状態Liに基づき、外力Fを、前記外力Fがロボットアーム5に加えられたときにロボットアーム5が動作可能な方向成分を抽出可能な変換外力Fhに変換する。
ただし、j1,j2,j3は式(13)を満たす3次元ベクトルであり、3×3行列[j1 j2 j3]は
例えば、関節角度qiがパターンB~Eのいずれかであり、かつ、関節角度qa、qbがパターンAとすると(ただし、この例では、qiは、q1、q2、q3のいずれか1つの関節角度を意味し、qa、qbは、関節角度q1、q2、q3のその他の2つの関節角度を意味する。)、
例えば、関節角度qiがパターンAであり、かつ、関節角度qa、qbがパターンB~Eのいずれかであるとすると(ただし、この例では、qiは、関節角度q1、q2、q3のいずれか1つの関節角度を意味し、qa、qbは、関節角度q1、q2、q3のその他の2つの関節角度を意味する。)、
となる。
また、並進外力fhは、並進外力fh2のベクトルの先端と、並進外力fh2の正射影fhCのベクトルの先端とを結んだ直線(点線)上に、先端が来る中間的な値であり、その位置は可動状態L3により定義される(可動状態L3=0のときにはfh=fhC、可動状態L3=1のときにはfh=fh2)。
また、並進外力fhは、並進外力fのベクトルの先端と、並進外力fの正射影fhcのベクトルの先端とを結んだ直線(点線)上に、先端が来る中間的な値であり、その位置は可動状態L2L3により定義される(可動状態L2L3=0のときにはfh=fhC、可動状態L3=1のときにはfh=f2)。
本発明の第2実施形態におけるロボットの基本的な構成は、図1及び図2に示した第1実施例の場合と同様であるので、共通部分の説明は省略し、異なる部分についてのみ以下、詳細に説明する。
本発明の第3実施形態における制御装置の基本的な構成は、図1及び図2に示した第1実施例の場合と同様であるので、共通部分の説明は省略し、異なる部分についてのみ以下、詳細に説明する。
Claims (11)
- 多関節ロボットアームと、
前記多関節ロボットアームに配設され、かつ、外力を検出する外力検出手段と、
前記多関節ロボットアームの関節が可動範囲のいずれかに位置して可動状態を計算する関節可動状態計算手段と、
前記関節可動状態計算手段により計算された前記関節の前記可動状態に基づき、前記外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に変換する外力変換手段と、
前記外力変換手段により変換された前記変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われるように前記多関節ロボットアームを制御する制御手段とを有するロボット。 - 前記外力変換手段は、前記外力検出手段に検出された前記外力を、前記多関節ロボットアームの前記関節が固定されたときに前記多関節ロボットアームの手先が動くことのできる拘束曲面の接平面への正射影として変換する請求項1に記載のロボット。
- さらに、前記多関節ロボットアームにかかる前記外力により各関節に発生する外力トルクを計算する外力トルク計算手段を有し、
前記関節可動状態計算手段は、前記外力トルク計算手段の計算結果に基づき前記外力トルクが前記多関節ロボットアームの各関節の動作を可動領域外より可動領域内に戻そうとする力であるかどうかを判定し、
前記関節可動状態計算手段が、前記外力トルクが前記多関節ロボットアームの各関節の動作を前記可動領域外より前記可動領域内に戻そうとする力であると判定する場合には、前記制御手段は前記動作制限を行わない一方、
前記関節可動状態計算手段が、前記外力トルクが前記多関節ロボットアームの各関節の動作を前記可動領域外より前記可動領域内に戻そうとする力ではないと判定する場合には、前記制御手段は前記動作制限を行う請求項1又は2に記載のロボット。 - 前記関節可動状態計算手段は、前記外力を関節トルクに変換することにより、前記関節トルクに変換された前記変換外力が、前記多関節ロボットアームの各関節の動作を可動領域外より可動領域内に戻そうとする力であるかどうかを判定し、
前記関節可動状態計算手段が、前記変換外力が、前記多関節ロボットアームの各関節の動作を前記可動領域外より前記可動領域内に戻そうとする力であると判定する場合には、前記制御手段は前記動作制限を行わない一方、
前記関節可動状態計算手段が、前記変換外力が、前記多関節ロボットアームの各関節の動作を前記可動領域外より前記可動領域内に戻そうとする力ではないと判定する場合には、前記制御手段は前記動作制限を行う請求項1又は2に記載のロボット。 - 前記多関節ロボットアームの各関節に対し、可動あるいは固定の動作モードを設定する動作モード設定部と、
前記動作モード設定部で設定された前記動作モードの指令が入力されて、前記動作モードと前記関節可動状態計算手段により計算された前記関節の前記可動状態とに基づき前記可動状態の計算を行う関節動作モード設定手段とをさらに備えて、
前記外力変換手段は、前記関節動作モード設定手段により計算された前記関節の前記可動状態に基づき、前記外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に変換し、
前記制御手段は、前記変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われる請求項1又は2に記載のロボット。 - 前記関節可動状態計算手段は、前記関節の可動領域の両端の境界線から一定範囲だけ内側に緩衝領域をそれぞれ設け、前記各緩衝領域では前記関節の前記可動状態を徐々に変化させる請求項3に記載のロボット。
- 前記多関節ロボットアームの前記関節の可動領域の両端の内側にそれぞれ設けられた緩衝領域と、前記緩衝領域を除く前記可動領域の残りの領域である完全可動領域PMRと、可動領域外の領域とに分割し、
前記関節可動状態計算手段は、各領域毎に、前記関節の前記可動状態の値を異ならせるように計算される請求項1に記載のロボット。 - 前記関節可動状態計算手段と前記力変換手段とが第2制御手段として、前記多関節アームの前記制御手段とは別に備えられ、
前記力変換手段が変換した外力が前記第2制御手段より通信を通じて前記制御手段に入力される請求項1に記載のロボット。 - 多関節ロボットアームを備えるロボットの制御装置であって、
前記多関節ロボットアームの関節が可動範囲のいずれかに位置して可動状態を計算する関節可動状態計算手段と、
前記関節可動状態計算手段により計算された前記関節の前記可動状態に基づき、前記多関節ロボットアームに配設されて外力を検出する外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に変換する外力変換手段と、
前記外力変換手段により変換された前記変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われるように前記多関節ロボットアームを制御する制御手段とを有するロボットの制御装置。 - 多関節ロボットアームを備えるロボットの制御方法であって、
前記多関節ロボットアームの関節が可動範囲のいずれかに位置して可動状態を関節可動状態計算手段で計算し、
前記計算された前記関節の前記可動状態に基づき、前記多関節ロボットアームに配設されて外力を検出する外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に外力変換手段で変換し、
前記変換された変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われるように前記多関節ロボットアームを制御手段で制御するロボットの制御方法。 - 多関節ロボットアームを備えるロボットの制御プログラムであって、
コンピュータを、
前記多関節ロボットアームの関節が可動範囲のいずれかに位置して可動状態を計算する関節可動状態計算手段と、
前記関節可動状態計算手段により計算された前記関節の前記可動状態に基づき、前記多関節ロボットアームに配設されて外力を検出する外力検出手段が検出した前記外力を、前記外力が前記ロボットアームに加えられたときに前記ロボットアームが動作可能な方向成分を抽出可能な変換外力に変換する外力変換手段と、
前記外力変換手段により変換された前記変換外力に基づいてインピーダンス制御を行うことにより、前記多関節ロボットアームの前記関節の前記可動状態に応じた動作制限が行われるように前記多関節ロボットアームを制御する制御手段として機能させるためのロボットの制御プログラム。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011541422A JP4896276B2 (ja) | 2010-01-04 | 2010-10-22 | ロボット、ロボットの制御装置、制御方法、及び制御プログラム |
CN201080029402.4A CN102470531B (zh) | 2010-01-04 | 2010-10-22 | 机器人、机器人的控制装置及控制方法 |
US13/241,579 US8396594B2 (en) | 2010-01-04 | 2011-09-23 | Robot, control device for robot, and control method of robot |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010-000084 | 2010-01-04 | ||
JP2010000084 | 2010-01-04 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US13/241,579 Continuation US8396594B2 (en) | 2010-01-04 | 2011-09-23 | Robot, control device for robot, and control method of robot |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2011080856A1 true WO2011080856A1 (ja) | 2011-07-07 |
Family
ID=44226288
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2010/006271 WO2011080856A1 (ja) | 2010-01-04 | 2010-10-22 | ロボット、ロボットの制御装置、及び制御方法 |
Country Status (4)
Country | Link |
---|---|
US (1) | US8396594B2 (ja) |
JP (1) | JP4896276B2 (ja) |
CN (1) | CN102470531B (ja) |
WO (1) | WO2011080856A1 (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013146794A (ja) * | 2012-01-17 | 2013-08-01 | Seiko Epson Corp | ロボット制御装置、ロボットシステム及びロボット制御方法 |
JP2013146793A (ja) * | 2012-01-17 | 2013-08-01 | Seiko Epson Corp | ロボット制御装置、ロボットシステム及びロボット制御方法 |
WO2013175777A1 (ja) * | 2012-05-23 | 2013-11-28 | パナソニック株式会社 | ロボット、ロボットの制御装置、制御方法、及び制御プログラム |
US9452532B2 (en) | 2014-01-27 | 2016-09-27 | Panasonic Intellectual Property Management Co., Ltd. | Robot, device and method for controlling robot, and computer-readable non-transitory recording medium |
JP2021011000A (ja) * | 2019-07-09 | 2021-02-04 | 株式会社東芝 | 協調制御装置およびロボットシステム |
Families Citing this family (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102015307B1 (ko) * | 2010-12-28 | 2019-08-28 | 삼성전자주식회사 | 로봇 및 그 제어 방법 |
CN103118842A (zh) * | 2011-03-17 | 2013-05-22 | 松下电器产业株式会社 | 机器人、机器人的控制装置、控制方法以及控制程序 |
DE102012102294B4 (de) * | 2011-03-18 | 2015-03-19 | Denso Wave Inc. | Verfahren zum Erfassen eines Achsenabstand-Versatzes eines 6-Achs-Roboters |
US9815193B2 (en) * | 2011-06-27 | 2017-11-14 | Delaware Capital Formation, Inc. | Electric motor based holding control systems and methods |
JP6128767B2 (ja) * | 2012-07-05 | 2017-05-17 | キヤノン株式会社 | ロボット制御装置、及びロボット制御方法 |
WO2014037999A1 (ja) * | 2012-09-04 | 2014-03-13 | 株式会社安川電機 | ロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置 |
JP5942311B2 (ja) * | 2013-02-25 | 2016-06-29 | パナソニックIpマネジメント株式会社 | ロボット、ロボットの制御装置及び制御方法、並びに、ロボット用制御プログラム |
ES2842078T3 (es) * | 2013-06-07 | 2021-07-12 | Francesco Autelli | Aparato para transferir personas y/o mercancías hacia o desde un buque |
CN103318812B (zh) * | 2013-07-09 | 2015-04-01 | 京东方科技集团股份有限公司 | 一种堆垛机用货叉组件及堆垛机、搬送卡匣的方法 |
CN103600354B (zh) * | 2013-11-08 | 2016-10-05 | 北京卫星环境工程研究所 | 航天器机械臂柔性随动控制重力补偿方法 |
CN103640022A (zh) * | 2013-11-13 | 2014-03-19 | 北京卫星环境工程研究所 | 航天器机械臂柔性随动控制方法 |
JP2015217451A (ja) * | 2014-05-14 | 2015-12-07 | ファナック株式会社 | 外力監視機能を有するワーク搬送方法システム |
JP6460690B2 (ja) * | 2014-09-16 | 2019-01-30 | キヤノン株式会社 | ロボット装置、ロボット制御方法、プログラム及び記録媒体 |
US9804593B1 (en) * | 2014-12-12 | 2017-10-31 | X Development Llc | Methods and systems for teaching positions to components of devices |
DE102015102642B4 (de) * | 2015-02-24 | 2017-07-27 | Kastanienbaum GmbH | Vorrichtung und Verfahren zur Steuerung und Regelung eines Roboter-Manipulators |
US10329042B2 (en) * | 2015-03-20 | 2019-06-25 | Seiko Epson Corporation | Packing apparatus and packing method |
JP6582483B2 (ja) * | 2015-03-26 | 2019-10-02 | セイコーエプソン株式会社 | ロボット制御装置およびロボットシステム |
JP6423815B2 (ja) | 2016-03-30 | 2018-11-14 | ファナック株式会社 | 人協働型のロボットシステム |
CN109476012B (zh) * | 2016-05-20 | 2021-12-28 | 夏普株式会社 | 机器人及其控制方法,以及记录介质 |
JP6755724B2 (ja) * | 2016-06-20 | 2020-09-16 | キヤノン株式会社 | 制御方法、ロボットシステム、および物品の製造方法 |
CN105928682A (zh) * | 2016-06-30 | 2016-09-07 | 苏州东菱振动试验仪器有限公司 | 模拟人体进出汽车座椅疲劳测试装置及测试方法 |
CN106475999B (zh) * | 2016-12-23 | 2018-11-09 | 东南大学 | 刚性条件下基于阻抗模型的双臂协调的加速度控制方法 |
JP6392910B2 (ja) | 2017-01-13 | 2018-09-19 | ファナック株式会社 | ロボットの安全確保動作機能を備えた人間協働ロボットシステム |
CN108406765B (zh) * | 2018-02-06 | 2021-05-07 | 南京航空航天大学 | 一种开链式多臂机器人阻抗控制方法 |
WO2019199933A1 (en) * | 2018-04-12 | 2019-10-17 | Corning Incorporated | Apparatus and method for engaging a moving glass ribbon |
EP4048484A4 (en) * | 2019-10-23 | 2023-07-05 | Abb Schweiz Ag | ROBOT CONTROL METHOD AND APPARATUS |
JP7451940B2 (ja) * | 2019-10-31 | 2024-03-19 | セイコーエプソン株式会社 | 制御方法および算出装置 |
JP2021146431A (ja) * | 2020-03-18 | 2021-09-27 | セイコーエプソン株式会社 | ロボットの制御方法及びロボットシステム |
CN115338855A (zh) * | 2021-05-14 | 2022-11-15 | 台达电子工业股份有限公司 | 双臂机器人组装*** |
CN114034318B (zh) * | 2021-11-23 | 2024-07-02 | 歌尔科技有限公司 | 音箱的校准控制方法、装置、设备及可读存储介质 |
CN115946120B (zh) * | 2023-01-09 | 2024-02-13 | 上海艾利特机器人有限公司 | 机械臂控制方法、装置、设备和介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000343469A (ja) * | 1999-06-01 | 2000-12-12 | Agency Of Ind Science & Technol | 物体協調運搬ロボットの制御方法及びその装置 |
JP2005014133A (ja) * | 2003-06-25 | 2005-01-20 | Honda Motor Co Ltd | アシスト搬送方法及びその装置 |
JP2009202280A (ja) * | 2008-02-27 | 2009-09-10 | Toyota Motor Corp | パワーアシスト装置及びその制御方法 |
JP2009262271A (ja) * | 2008-04-24 | 2009-11-12 | Toyota Motor Corp | パワーアシスト装置およびその制御方法 |
Family Cites Families (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3369351B2 (ja) * | 1995-03-28 | 2003-01-20 | 富士通株式会社 | 多関節マニピュレータの弾性設定方法および制御装置 |
US6786896B1 (en) * | 1997-09-19 | 2004-09-07 | Massachusetts Institute Of Technology | Robotic apparatus |
US6522952B1 (en) | 1999-06-01 | 2003-02-18 | Japan As Represented By Secretary Of Agency Of Industrial Science And Technology | Method and system for controlling cooperative object-transporting robot |
US7443115B2 (en) * | 2002-10-29 | 2008-10-28 | Matsushita Electric Industrial Co., Ltd. | Apparatus and method for robot handling control |
JP3751309B2 (ja) * | 2002-12-12 | 2006-03-01 | 松下電器産業株式会社 | ロボット制御装置 |
CA2530372A1 (en) | 2003-06-25 | 2005-01-06 | Honda Motor Co., Ltd. | Assist transportation method and device |
US7603199B2 (en) * | 2003-11-27 | 2009-10-13 | Honda Motor Co., Ltd. | Control device for mobile body |
US7313463B2 (en) * | 2005-03-31 | 2007-12-25 | Massachusetts Institute Of Technology | Biomimetic motion and balance controllers for use in prosthetics, orthotics and robotics |
JP4682791B2 (ja) * | 2005-10-12 | 2011-05-11 | ソニー株式会社 | 操作空間物理量算出装置及び操作空間物理量算出方法、並びにコンピュータ・プログラム |
CN1994689B (zh) * | 2005-12-28 | 2011-02-16 | 松下电器产业株式会社 | 机器人及机器人检测自动化方法 |
CN101870108B (zh) * | 2006-01-13 | 2011-09-28 | 松下电器产业株式会社 | 机械手臂的控制装置 |
JP4508164B2 (ja) * | 2006-06-26 | 2010-07-21 | トヨタ自動車株式会社 | 多関節ロボット及びその制御プログラム |
CN101432103B (zh) * | 2006-07-04 | 2012-05-23 | 松下电器产业株式会社 | 机器人手臂的控制装置 |
CN102229147B (zh) * | 2007-06-27 | 2014-01-29 | 松下电器产业株式会社 | 机器手控制装置及控制方法、机器人 |
WO2009004772A1 (ja) * | 2007-07-05 | 2009-01-08 | Panasonic Corporation | ロボットアームの制御装置及び制御方法、ロボット、及び制御プログラム |
CN101952087B (zh) * | 2008-02-06 | 2013-01-16 | 松下电器产业株式会社 | 机器人、机器人的控制装置及控制方法 |
-
2010
- 2010-10-22 WO PCT/JP2010/006271 patent/WO2011080856A1/ja active Application Filing
- 2010-10-22 CN CN201080029402.4A patent/CN102470531B/zh active Active
- 2010-10-22 JP JP2011541422A patent/JP4896276B2/ja active Active
-
2011
- 2011-09-23 US US13/241,579 patent/US8396594B2/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000343469A (ja) * | 1999-06-01 | 2000-12-12 | Agency Of Ind Science & Technol | 物体協調運搬ロボットの制御方法及びその装置 |
JP2005014133A (ja) * | 2003-06-25 | 2005-01-20 | Honda Motor Co Ltd | アシスト搬送方法及びその装置 |
JP2009202280A (ja) * | 2008-02-27 | 2009-09-10 | Toyota Motor Corp | パワーアシスト装置及びその制御方法 |
JP2009262271A (ja) * | 2008-04-24 | 2009-11-12 | Toyota Motor Corp | パワーアシスト装置およびその制御方法 |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013146794A (ja) * | 2012-01-17 | 2013-08-01 | Seiko Epson Corp | ロボット制御装置、ロボットシステム及びロボット制御方法 |
JP2013146793A (ja) * | 2012-01-17 | 2013-08-01 | Seiko Epson Corp | ロボット制御装置、ロボットシステム及びロボット制御方法 |
WO2013175777A1 (ja) * | 2012-05-23 | 2013-11-28 | パナソニック株式会社 | ロボット、ロボットの制御装置、制御方法、及び制御プログラム |
JP5695223B2 (ja) * | 2012-05-23 | 2015-04-01 | パナソニックIpマネジメント株式会社 | ロボット、ロボットの制御装置、制御方法、及び制御プログラム |
US9102054B2 (en) | 2012-05-23 | 2015-08-11 | Panasonic Intellectual Property Management Co., Ltd. | Robot, robot control apparatus, robot control method, and robot control program |
US9452532B2 (en) | 2014-01-27 | 2016-09-27 | Panasonic Intellectual Property Management Co., Ltd. | Robot, device and method for controlling robot, and computer-readable non-transitory recording medium |
JP2021011000A (ja) * | 2019-07-09 | 2021-02-04 | 株式会社東芝 | 協調制御装置およびロボットシステム |
JP7370746B2 (ja) | 2019-07-09 | 2023-10-30 | 株式会社東芝 | 協調制御装置およびロボットシステム |
Also Published As
Publication number | Publication date |
---|---|
US8396594B2 (en) | 2013-03-12 |
JPWO2011080856A1 (ja) | 2013-05-09 |
CN102470531B (zh) | 2016-01-20 |
US20120010747A1 (en) | 2012-01-12 |
JP4896276B2 (ja) | 2012-03-14 |
CN102470531A (zh) | 2012-05-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4896276B2 (ja) | ロボット、ロボットの制御装置、制御方法、及び制御プログラム | |
US9002519B2 (en) | Robot control method, robot control device, and robot control system | |
JP4243309B2 (ja) | ロボットアームの制御装置 | |
JP5399593B2 (ja) | ロボット、ロボットの制御装置、制御方法、及び制御プログラム | |
JP5129415B2 (ja) | ロボット、ロボットの制御装置、制御方法、及び制御プログラム | |
WO2001038048A1 (fr) | Unite de commande de robot | |
US8428780B2 (en) | External force target generating device of legged mobile robot | |
US8442680B2 (en) | Motion state evaluation apparatus of legged mobile robot | |
US9676100B2 (en) | Control apparatus of robot, robot, and program thereof | |
US20110087374A1 (en) | Robot system | |
US20110213498A1 (en) | Desired motion evaluation apparatus of legged mobile robot | |
JP7068133B2 (ja) | 制御システム、制御方法、及び制御プログラム | |
CN113927592B (zh) | 一种基于自适应降阶滑模算法的机械臂力位混合控制方法 | |
JP4134369B2 (ja) | ロボットの制御装置 | |
WO2013183190A1 (ja) | ロボットシステム、ロボット制御装置、及びロボットシステムの制御方法 | |
JP2010036293A (ja) | 多関節ロボット | |
JPH11345010A (ja) | ロボットの制御装置 | |
JPH0760667A (ja) | ロボットのウィービング制御装置 | |
JPH058187A (ja) | ロボツト | |
JP2014159066A (ja) | ロボット制御装置及びロボットの制御方法 | |
Nishiwaki et al. | Object manipulation by hand using whole-body motion coordination | |
WO2020184203A1 (ja) | ロボット制御装置及びロボット制御方法 | |
JP2012056075A (ja) | マニピュレータ及びその制御方法 | |
JPH10225884A (ja) | 作業ロボット及びその制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
WWE | Wipo information: entry into national phase |
Ref document number: 201080029402.4 Country of ref document: CN |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 10840719 Country of ref document: EP Kind code of ref document: A1 |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2011541422 Country of ref document: JP |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 10840719 Country of ref document: EP Kind code of ref document: A1 |