WO2022210186A1 - ロボットの位置および姿勢を制御するパラメータを算出する制御装置 - Google Patents
ロボットの位置および姿勢を制御するパラメータを算出する制御装置 Download PDFInfo
- Publication number
- WO2022210186A1 WO2022210186A1 PCT/JP2022/013623 JP2022013623W WO2022210186A1 WO 2022210186 A1 WO2022210186 A1 WO 2022210186A1 JP 2022013623 W JP2022013623 W JP 2022013623W WO 2022210186 A1 WO2022210186 A1 WO 2022210186A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- work
- workpiece
- robot
- force
- control
- Prior art date
Links
- 230000033001 locomotion Effects 0.000 claims description 86
- 230000009471 action Effects 0.000 claims description 38
- 210000000707 wrist Anatomy 0.000 claims description 7
- 238000010586 diagram Methods 0.000 description 29
- 238000000034 method Methods 0.000 description 16
- 230000008859 change Effects 0.000 description 9
- 239000013598 vector Substances 0.000 description 6
- 210000000078 claw Anatomy 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 230000005611 electricity Effects 0.000 description 2
- 238000005401 electroluminescence Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/085—Force or torque sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1687—Assembly, peg and hole, palletising, straight line, weaving pattern movement
-
- 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/39529—Force, torque sensor in wrist, end effector
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40032—Peg and hole insertion, mating and joining, remote center compliance
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40586—6-DOF force sensor
Definitions
- the present invention relates to a control device that calculates parameters for controlling the position and orientation of a robot.
- a robot device is equipped with a robot and a work tool attached to the robot, and can perform a predetermined task while the robot changes its position and posture.
- a robot apparatus in which a hand for gripping a work is attached as a work tool and the work is arranged at a predetermined position.
- a control of fitting one work to another work there is known a control of fitting one work to another work.
- control is known in which another work is brought into contact with a predetermined position of one work.
- a robot device that inserts a workpiece into a hole or the like of a member fixed to a workbench (for example, Japanese Unexamined Patent Publication No. 4-256526).
- the robot controller corrects the position and posture of the robot while moving one work toward another work.
- a force sensor to attach a force sensor to a robot to perform force control such as compliance control.
- force control the position and posture of the robot can be corrected so that the force in a predetermined direction detected by the force sensor is within the determination range (for example, Japanese Patent Application Laid-Open No. 2008-307634 and Japanese Patent Laid-Open No. 2017-127932).
- force control it is possible to adjust the position and orientation of the workpiece gripped by the robot based on the output of the force sensor attached to the robot.
- control points for moving the workpiece by the robot can be set at the tip point of the workpiece or the tip point of the work tool.
- a moving direction (vector) in advance as a moving direction for fitting or pressing a work.
- Parameters including such control points and movement directions can be specified in at least one of the tool coordinate system having the origin in the work tool and the user coordinate system set by the operator.
- the origin of the coordinate system can be set as the control point and the direction of one coordinate axis of the coordinate system can be set as the movement direction. Then, the robot can be controlled based on the position of the origin of the coordinate system and the movement direction.
- the tool coordinate system and user coordinate system can be set by driving the actual robot.
- the operator uses the reference coordinate system set on the robot to determine the positions of three points in space, and the X-axis and Y-axis Set a vector parallel to .
- the operator sets up a user coordinate system including the X, Y, and Z axes by specifying the position of the origin.
- One aspect of the present disclosure is a control device that calculates parameters for performing force control when a robot moves a first work toward a second work.
- the control device includes a force detector that detects a force applied to one of the first workpiece and the contact member when the robot brings the first workpiece into contact with the contact member having the corner.
- the control device includes a parameter calculator that calculates the direction of movement of the first work relative to the second work and the position of the work end point that is the control point of the force control when force control is performed.
- the force detector detects force during a period in which the robot contacts the tip of the first workpiece with the corner of the contact member and presses the first workpiece along a predetermined pressing direction. do.
- the parameter calculation unit acquires the force detected by the force detector corresponding to each pressing direction when the first workpiece is pressed against the contact member in a plurality of pressing directions, and corresponds to the plurality of pressing directions.
- the moving direction of the first work and the position of the work end point of the first work are calculated based on the applied force.
- the control device includes a force detector that detects a force applied to one of the first work piece and the contact member when the contact member having the corner portion is brought into contact with the first work piece by the robot.
- the control device includes a parameter calculation unit that calculates the direction of movement of the second work relative to the first work when force control is performed and the position of the work end point that is the control point for force control.
- the force detector detects the force while the robot contacts the corner of the contact member with the workpiece tip point of the first workpiece and presses the contact member along a predetermined pressing direction.
- the parameter calculation unit acquires the force detected by the force detector corresponding to each pressing direction when the contact member is pressed against the first workpiece in a plurality of pressing directions, and corresponds to the plurality of pressing directions.
- the movement direction of the second work and the position of the work end point of the first work are calculated based on the applied force.
- FIG. 1 is a schematic diagram of a first robot device in an embodiment
- FIG. 1 is a block diagram of a first robot device in an embodiment
- FIG. FIG. 5 is an enlarged perspective view when fitting the first work to the second work
- FIG. 4 is a schematic diagram of the first robot device when bringing the end face of the first work into contact with the corner of the second work
- FIG. 11 is an enlarged perspective view when the corner of the second work is brought into contact with the first work
- FIG. 4 is a first schematic diagram for explaining a method of calculating the position and moving direction of the tip point of the workpiece
- FIG. 11 is a second schematic diagram for explaining a method of calculating the position and movement direction of the tip point of the workpiece
- FIG. 10 is a schematic diagram of the first robot apparatus for explaining a work tip point and a moving direction generated by a parameter setting procedure; It is an image of a robot and a workpiece displayed on the display section of the teaching console.
- FIG. 11 is a schematic diagram of the second robot device in an embodiment.
- FIG. 11 is a schematic diagram of the second robot device when the corner of the second work is brought into contact with the end surface of the first work;
- FIG. 11 is an enlarged perspective view when the corner of the second work is brought into contact with the end face of the first work;
- FIG. 11 is a schematic diagram of a second robot apparatus for explaining a work tip point and a movement direction generated by a parameter setting procedure;
- It is a schematic diagram of a third robot device in an embodiment.
- FIG. 11 is a schematic diagram of the third robot device when bringing the end face of the first work into contact with the corner of the second work;
- FIG. 11 is a schematic diagram of a third robot apparatus for explaining a work tip point and a movement direction generated by a parameter setting procedure;
- It is a schematic diagram of a fourth robot device in the embodiment.
- FIG. 11 is a schematic diagram of the fourth robot device when bringing the end face of the first work into contact with the corner of the second work;
- FIG. 11 is a schematic diagram of a fourth robot apparatus for explaining a work tip point and a movement direction generated by a parameter setting procedure;
- FIG. 1 is a schematic diagram of a first robot apparatus according to this embodiment.
- a first robot device 5 includes a hand 2 as a work tool and a robot 1 that moves the hand 2 .
- the robot 1 of this embodiment is a multi-joint robot including a plurality of joints 18 .
- the robot 1 includes a plurality of moveable components.
- the components of robot 1 are configured to rotate about respective drive axes.
- the robot 1 includes a base portion 14 and a swivel base 13 that rotates with respect to the base portion 14 .
- Robot 1 includes upper arm 11 and lower arm 12 .
- the lower arm 12 is rotatably supported by the swivel base 13 .
- the upper arm 11 is rotatably supported by the lower arm 12 .
- the robot 1 includes a wrist portion 15 rotatably supported by the upper arm 11 .
- the hand 2 is fixed to the flange 16 of the wrist portion 15 .
- the upper arm 11 and flange 16 rotate about another drive axis.
- the robot of this embodiment has six drive axes, it is not limited to this form. A robot that changes its position and orientation with any mechanism can be employed.
- the work tool of the present embodiment is a hand having two claws, it is not limited to this form. Any device capable of gripping a workpiece can be employed as the work tool.
- a reference coordinate system 81 is set in the robot device 5 of the present embodiment.
- the origin of the reference coordinate system 81 is arranged on the base portion 14 of the robot 1 .
- the reference coordinate system 81 is also called the world coordinate system.
- the reference coordinate system 81 is a coordinate system in which the position of the origin is fixed and the directions of the coordinate axes are fixed. Even if the position and orientation of the robot 1 change, the position and orientation of the reference coordinate system 81 do not change.
- the coordinate system of the present embodiment has an X-axis, a Y-axis, and a Z-axis that are orthogonal to each other as coordinate axes.
- the coordinate system also has a W axis about the X axis, a P axis about the Y axis, and an R axis about the Z axis.
- a tool coordinate system having an origin set at an arbitrary position on the work tool is set in the robot device 5 .
- the origin of the tool coordinate system is set at the tool tip point, which is the middle point between the tips of the two claws of the hand 2 .
- a tool coordinate system is a coordinate system that changes position and orientation with the work tool.
- the position of the robot 1 corresponds to, for example, the position of the origin of the tool coordinate system.
- the posture of the robot 1 corresponds to the orientation of the tool coordinate system with respect to the reference coordinate system 81 .
- a flange coordinate system 83 having an origin at the flange 16 of the wrist portion 15 is set in the robot device 5 .
- Flange coordinate system 83 is a coordinate system that moves and rotates with flange 16 .
- the flange coordinate system 83 is set, for example, such that the origin is located on the surface of the flange 16 and the Z axis overlaps the rotation axis of the flange 16 .
- FIG. 2 shows a block diagram of the robot device according to this embodiment.
- robot 1 includes a robot driving device that changes the position and posture of robot 1 .
- the robot drive includes robot drive motors 22 that drive components such as arms and wrists.
- a plurality of robot drive motors 22 are arranged corresponding to each drive shaft.
- the robot device 5 includes a hand driving device that drives the hand 2.
- the hand drive device includes a hand drive motor 21 that drives the claw portion of the hand 2 . As the hand driving motor 21 is driven, the claw portion of the hand 2 is opened and closed.
- the hand may be formed so as to be driven by air pressure or the like.
- the robot device 5 includes a control device 4 that controls the robot 1 and the hand 2.
- the control device 4 includes a control device main body 40 that performs control, and a teaching operation panel 37 for an operator to operate the control device main body 40 .
- the control device body 40 includes an arithmetic processing device (computer) having a CPU (Central Processing Unit) as a processor.
- the arithmetic processing unit has a RAM (Random Access Memory), a ROM (Read Only Memory), etc., which are connected to the CPU via a bus.
- the teaching operation panel 37 is connected to the control device body 40 via a communication device.
- the teaching operation panel 37 includes an input section 38 for inputting information regarding the robot 1 and the hand 2 .
- the input unit 38 is composed of input members such as a keyboard and dials.
- the teaching operation panel 37 includes a display section 39 that displays information regarding the robot 1 and hand 2 .
- the display unit 39 can be configured by an arbitrary display panel such as a liquid crystal display panel or an organic EL (Electro Luminescence) display panel.
- An operation program 46 created in advance for operating the robot 1 and the hand 2 is input to the control device 4 .
- the operator can set the teaching point of the robot 1 by operating the teaching operation panel 37 to drive the robot 1 .
- the control device 4 can generate an operation program 46 for the robot 1 and hand 2 based on the teaching points.
- the operating program 46 is stored in the storage unit 42 .
- the control device main body 40 includes a motion control section 43 that controls motions of the robot 1 and the hand 2 .
- the motion control unit 43 sends motion commands for driving the robot 1 to the robot driving unit 45 based on the motion program 46 .
- Robot drive section 45 includes an electrical circuit that drives robot drive motor 22 .
- the robot driving section 45 supplies electricity to the robot driving motor 22 based on the operation command.
- the motion control unit 43 also sends an operation command for driving the hand 2 to the hand driving unit 44 based on the operation program 46 .
- the hand drive section 44 includes an electric circuit that drives the hand drive motor 21 .
- the hand drive unit 44 supplies electricity to the hand drive motor 21 based on the operation command.
- the control device main body 40 includes a storage section 42 that stores information regarding control of the robot 1 and hand 2 .
- the storage unit 42 can be configured by a non-temporary storage medium capable of storing information.
- the storage unit 42 can be configured with a storage medium such as a volatile memory, a nonvolatile memory, a magnetic storage medium, or an optical storage medium.
- the operation control unit 43 corresponds to a processor driven according to the operation program 46.
- the operation control section 43 is formed so as to be able to read information stored in the storage section 42 .
- the processor functions as the operation control unit 43 by reading the operation program 46 and performing control defined in the operation program 46 .
- Robot 1 includes a state detector for detecting the position and orientation of robot 1 .
- the state detectors in this embodiment include position detectors 19 that detect the rotational positions attached to the robot drive motors 22 of the respective drive shafts.
- the position detector 19 can be composed of an encoder that detects the rotation angle of the output shaft of the robot drive motor 22 .
- the position and posture of robot 1 are detected based on the outputs of a plurality of position detectors 19 .
- the control device 4 of the first robot device 5 includes a force sensor 24 as a force detector attached to the robot 1.
- the force sensor 24 of this embodiment is a 6-axis sensor.
- the force sensor 24 is arranged between the flange 16 and the hand 2 .
- the force sensor 24 detects force and moment acting on the workpiece 71 .
- any force sensor such as a sensor including a strain sensor or a capacitive sensor can be adopted.
- the forces detected by the force sensor 24 in the present embodiment include forces in directions of three mutually orthogonal axes in the sensor coordinate system and forces around the three axes. More specifically, the force sensor 24 detects forces in directions of orthogonal three axes (X-axis, Y-axis and Z-axis) and forces in directions of axes (W-axis, P-axis and R-axis) around the three axes. to detect the moment (Mx, My, Mz) of .
- the first robot device 5 in the present embodiment performs control to fit the first work 71 to the second work 72 .
- the robot device 5 moves the first work 71 toward the second work 72 with the robot 1 .
- the first work 71 is inserted into the concave portion 72 a of the second work 72 as indicated by an arrow 91 .
- FIG. 3 shows an enlarged perspective view of the first work and the second work in this embodiment.
- the first workpiece 71 of this embodiment has a cylindrical shape.
- the end face of the first work 71 is circular.
- the second workpiece 72 has a rectangular parallelepiped shape.
- a second work 72 is fixed to a workbench 75 .
- the second workpiece 72 has a recess 72a formed on its surface.
- the concave portion 72a is formed in a cylindrical shape.
- the concave portion 72a has a shape corresponding to the shape of the first work 71 so that the first work 71 is fitted therein.
- the control device 4 performs control to fit the cylindrical work 71 into the recess 72 a of the work 72 as indicated by an arrow 91 .
- the central axis 71a of the work 71 and the central axis 72aa of the recess 72a are aligned, the work 71 is smoothly inserted into the recess 72a of the work 72.
- the central axis 72aa may deviate in position or posture with respect to the central axis 71a.
- the control device 4 performs force control based on the output of the force sensor 24 when fitting the workpiece 71 into the recess 72a.
- control for adjusting the position and posture of the robot based on the force detected by the force detector is called force control.
- Force control utilizes the force generated when the workpieces come into contact with each other.
- the control device 4 can perform control to change the speed in the direction perpendicular to the movement direction of the work and control to change the orientation of the work.
- the control device 4 can perform compliance control, impedance control, or the like based on the force detected by the force sensor 24, for example.
- a control point that serves as a reference for force control and a movement direction (vector) for moving the workpiece by the robot are required.
- a control point can be placed at any arbitrary position of either the workpiece moved by the robot or another workpiece in contact with the workpiece.
- a work tip point 65 as a control point is set on the end surface of the first work 71 .
- the workpiece tip point 65 is arranged at the center of the planar circle on the end surface of the first workpiece 71 .
- the direction indicated by an arrow 66 is set as the moving direction of the work 71 supported by the robot 1 when fitting the work 71 into the recess 72a.
- the position and posture of the robot can be controlled so that the force applied to the control point in directions other than the direction parallel to the movement direction and the moment around the control point are less than predetermined judgment values.
- the fitting operation can be performed while correcting the position and posture of the first work 71 with respect to the recess 72a.
- the control device 4 includes a parameter calculator 51 that calculates parameters for performing force control.
- the parameter calculator 51 includes a movement direction calculator 52 that calculates the direction of movement of the first work 71 relative to the second work 72 when performing force control.
- the parameter calculation unit 51 includes a position calculation unit 53 that calculates the position of the work tip point placed on the end face of the first work 71 .
- the parameter calculator 51 includes a display controller 54 that controls the image displayed on the display 39 of the teaching console 37 .
- the operation program 46 includes a calculation program for calculating parameters for implementing force control.
- the parameter calculator 51 corresponds to a processor driven according to this calculation program.
- the processor functions as the parameter calculator 51 by executing control defined in the calculation program.
- each unit of the movement direction calculation unit 52, the position calculation unit 53, and the display control unit 54 corresponds to a processor driven according to a calculation program.
- the processors function as respective units by executing the control defined in the calculation program.
- control for calculating parameters for performing force control is referred to as parameter setting procedure.
- the position of the work tip point 65 as a control point is calculated.
- a moving direction (vector) indicated by an arrow 66 for moving the first work 71 with respect to the second work 72 is calculated.
- FIG. 4 shows a schematic diagram of the first robot device for explaining the operation of the robot in the parameter setting procedure.
- FIG. 5 shows an enlarged perspective view of a portion where the first work is in contact with the second work. Referring to FIGS. 4 and 5, the operator manually changes the position and posture of robot 1 by operating teaching operation panel 37 .
- the second work 72 is used as a contact member for bringing the first work 71 into contact.
- the contact member is a member having a corner configured with a sharp tip that can be brought into contact with the first work 71 .
- the operator changes the position and posture of the robot 1 so that the end face 71b of the work 71 contacts the corner 72b of the work 72 with the end point of the work 71 when performing the actual fitting work.
- a contact point between the workpiece 71 and the workpiece 72 is a workpiece tip point 65 .
- the control of pressing the first work 71 against the second work 72 is performed multiple times. At this time, the direction in which the first work 71 is pressed against the second work 72 is changed. In this embodiment, a direction in which one member is pressed toward another member is called a pressing direction.
- the pressing direction can be determined in advance by the operator.
- the parameter calculation unit 51 acquires the force detected by the force sensor 24 corresponding to each pressing direction.
- the parameter calculator 51 calculates the movement direction of the first work and the position of the work end point of the first work based on the forces corresponding to the plurality of pressing directions.
- the operator drives the robot 1 so as to press the first work 71 in the predetermined pressing direction indicated by the arrow 92 .
- the arrow 92 corresponds to the direction (moving direction) in which the first workpiece 71 is moved when the actual fitting work is performed.
- the operator drives the robot 1 so that the hand 2 moves in a direction substantially parallel to the central axis of the cylindrical workpiece 71 .
- the force sensor 24 detects the force applied to the work 71 while the robot 1 is being driven so that the first work 71 presses the second work 72 .
- a sensor coordinate system 82 is set in the force sensor 24 for detecting the force applied to the sensor.
- the operator presses the first work 71 in a predetermined pressing direction indicated by an arrow 93 .
- the robot 1 is driven so as to press the first work 71 against the second work 72 in a direction different from the direction in which the first work 71 is pressed the first time.
- the force sensor 24 detects the force applied to the work 71 while the robot 1 is being driven so that the first work 71 presses the second work 72 .
- FIG. 6 shows a first schematic diagram for explaining the method of calculating the pressing direction of the workpiece and the position of the contact point.
- the first workpiece 71 is gripped by the gripping member 9 corresponding to the hand.
- a force sensor 24 is attached to the grasping member 9 .
- An origin 82 a of the sensor coordinate system is set in the force sensor 24 .
- FIG. 6 shows a state in which the first workpiece 71 is pressed in the first pressing direction. By driving the robot, the first work 71 is pressed in the direction indicated by the arrow 92 toward the second work 72 .
- the force sensor 24 detects forces in the X-, Y-, and Z-axis directions and moments in the W-, P-, and R-axis directions in the sensor coordinate system.
- the first work In the first control of pressing the first work 71, the first work is pressed in the direction indicated by the arrow 92.
- the movement direction calculator 52 detects the direction in which the first work 71 is pressed against the second work 72 .
- the movement direction calculator 52 acquires the force component of each orthogonal axis (X-axis, Y-axis, and Z-axis) output by the force sensor 24 .
- the movement direction calculator 52 calculates the pressing direction of the workpiece 71 indicated by an arrow 92 from the force components of the respective orthogonal axes.
- the force sensor 24 detects moments (Mx, My, Mz) about each axis (W-axis, P-axis, and R-axis) around the orthogonal axis, as indicated by arrows 96 .
- the position calculator 53 calculates the position vector of the proximity point 67 closest to the line parallel to the pressing direction of the workpiece from the origin 82a of the sensor coordinate system 82, as indicated by the arrow 97, based on the moment of each axis. .
- the position calculator 53 calculates a line of action 85 that is parallel to the pressing direction of the workpiece 71 indicated by the arrow 92 and that passes through the proximity point 67 .
- a work tip point 65 as a contact point exists on the line of action 85 . In this way, the line of action 85 passing through the proximity point 67 can be calculated as the range in which the workpiece tip point 65 exists.
- Fig. 7 shows a second schematic diagram for explaining the method of calculating the pressing direction of the workpiece and the position of the contact point.
- the pressing direction of the first work 71 is set to a direction different from that of the first work pressing control. That is, the first work 71 is pressed toward the second work along different directions.
- the first workpiece 71 is pressed in the direction indicated by arrow 93 .
- the movement direction calculator 52 calculates the pressing direction of the workpiece 71 indicated by an arrow 93 from the force components of the respective orthogonal axes.
- the position calculator 53 calculates a line of action 86 passing through the proximity point 67 and parallel to the pressing direction of the workpiece 71 .
- the work tip point 65 exists on the line of action 86 .
- the position calculator 53 calculates the intersection of the line of action 85 corresponding to the first pressing direction and the line of action 86 corresponding to the second pressing direction.
- the position calculator 53 sets this intersection point as the workpiece tip point 65 .
- the position calculator 53 calculates the position of the intersection point as the position of the workpiece tip point 65 . In this way, the position calculator 53 can calculate the intersection point of a plurality of lines of action as the work tip point.
- the moving direction calculation unit 52 can set one of the detected pressing directions in the control of pressing the workpiece a plurality of times as the moving direction when force control is performed.
- the movement direction calculator 52 sets the direction indicated by the arrow 92 in the first pressing control as the movement direction. The operator can select the pressing direction to be set as the movement direction from among the plurality of pressing directions calculated by the pressing control performed multiple times.
- control is performed to press the workpiece in two pressing directions, but the present invention is not limited to this mode.
- Control for pressing the workpiece in three or more pressing directions may be performed.
- the position calculator acquires the force detected by the detector corresponding to each pressing direction.
- the position calculator calculates a plurality of lines of action corresponding to a plurality of pressing directions.
- the position calculation unit can calculate intersection points of a plurality of lines of action as contact points.
- the position calculator can calculate the position of the tip point of the workpiece based on the distances from the plurality of lines of action.
- the position calculation unit can calculate a point having a small distance from a plurality of lines of action as a contact point. For example, the position calculator can calculate a point with the smallest sum or variance of distances from a plurality of lines of action as the contact point.
- FIG. 8 shows a schematic diagram of the robot apparatus showing the workpiece tip point set on the first workpiece and the movement direction of the workpiece.
- the moving direction indicated by the arrow 66 and the workpiece tip point 65 move together with the first workpiece 71 .
- the direction of movement and the position of the tip of the workpiece can be calculated using the coordinate values of the sensor coordinate system 82 .
- the movement direction calculator 52 can calculate the movement direction indicated by the arrow 66 in the sensor coordinate system 82 .
- the position calculator 53 can calculate the position of the workpiece tip point 65 in the sensor coordinate system 82 .
- the relative position and orientation of the sensor coordinate system 82 with respect to the flange coordinate system 83 set on the flange 16 of the robot 1 are determined in advance.
- the parameter calculator 51 is calibrated so that the coordinate values of the sensor coordinate system 82 can be converted into the coordinate values of the flange coordinate system 83 .
- the parameter calculation unit 51 converts the moving direction and the work end point position represented by the sensor coordinate system 82 into the moving direction and the work end point position represented by the flange coordinate system 83 .
- the parameter calculation unit 51 can set the movement direction and the position of the tip end point of the workpiece expressed in the flange coordinate system 83 in the operation program 46 as parameters (set values) for force control.
- the display control unit 54 can display the calculated movement direction and the position of the workpiece tip point on the display unit 39 .
- the operator can set the position and movement direction of the workpiece end point in the operation program 46 by looking at the display on the display unit 39 .
- the operator designates the position and posture of the work 71 with respect to the work 72 when starting the work of fitting the work 71 .
- the operator operates the teaching operation panel 37 to change the position and posture of the robot 1 so that the workpiece 71 is placed directly above the recess 72a as shown in FIGS.
- the position and attitude of the work 71 are changed so that the center axis 72aa of the recess 72a and the center axis 71a of the work 71 are arranged substantially linearly.
- the position and posture of the robot 1 at this time are the initial position and posture of the robot when the control for fitting the first work 71 to the second work 72 is started.
- the parameter calculation unit 51 sets the initial position and orientation of the robot in the motion program 46 .
- the display control unit 54 can display the initial position and posture of the robot on the display unit 39 so that the operator can set it in the operation program 46 .
- the motion control unit 43 adjusts the position and posture of the robot 1 based on the motion program 46 so that the workpiece 71 assumes the initial position and posture. Control.
- the motion control section 43 starts force control.
- the motion control unit 43 moves the work 71 in the moving direction indicated by the arrow 66 .
- the force sensor 24 detects force.
- the motion control unit 43 can convert the force detected by the force sensor 24 into a force acting on the tip point 65 of the workpiece. Then, the position and posture of the robot can be controlled so that the force acting on the workpiece tip point 65 is within a predetermined determination range. Thus, force control can be performed based on the direction of movement indicated by arrow 66 and the position of workpiece tip point 65 .
- the second work 72 is used as the contact member that makes contact with the first work 71, but it is not limited to this form. Any member including a corner having a vertex can be adopted as the contact member.
- a jig having corners may be fixed to a workbench, and the end face of the first work may be brought into contact with the corners of the jig.
- the robot is operated using the teaching operation panel to bring the first work into contact with the second work, but the present invention is not limited to this form.
- the operator can manually implement any controls that change the position and attitude of the robot. For example, by arranging a force sensor on the base of the robot, it is possible to operate the robot in a manner similar to direct teaching. The operator can change the position and posture of the robot by directly pushing or pulling the components of the robot.
- display control unit 54 in the present embodiment performs the operation of bringing end face 71b of first work 71 into contact with corner 72b of second work 72, and displays the first An image can be displayed so that the direction of the force pressing the workpiece 71 can be seen.
- Fig. 9 shows an image displayed on the display unit.
- image 61 the portion where the first work contacts the second work is enlarged.
- three-dimensional shape data 58 of robot device 5 first work 71 and second work 72 are stored in storage unit 42 in the present embodiment.
- the display control unit 54 creates a model of each member based on the three-dimensional shape data 58 .
- the actual position of the robot device and the position of the workpiece are entered in advance.
- the display control unit 54 arranges the model in the virtual space according to the actual position of the robot device and the position of the workpiece.
- the display control unit 54 generates an image of the model of the workpiece when viewed from a predetermined direction. Also, the display control unit 54 acquires the position and posture of the robot 1 based on the output of the position detector 19 .
- the display control unit 54 generates a model image of the robot device based on the position and orientation of the robot 1 .
- a first workpiece model 71M and a second workpiece model 72M are displayed.
- a hand model 2M, a force sensor model 24M, a wrist model 15M, and an upper arm model 11M are displayed.
- the display control unit 54 acquires the pressing direction of the work 71 from the moving direction calculation unit 52 .
- the display control unit 54 displays an arrow indicating the pressing direction on the image.
- the display control unit 54 displays an arrow 99M in the direction that the work 71 is pressing so as to extend from the corner of the model 72M of the second work.
- the display control unit 54 controls the movement direction calculation unit 100 during the period in which the robot is driven so as to press one of the first work 71 and the second work 72 toward the other work.
- the pressing direction of the work calculated at 52 is obtained and displayed superimposed on the image of the robot 1 .
- the position calculation unit 53 can calculate the position of the contact point by performing the control of pressing the workpiece for the second and subsequent times. For this reason, the display control unit 54 may acquire the position of the contact point from the position calculation unit 53 and display the contact point superimposed on the image of the robot 1 .
- the operator can confirm the pressing direction of the first work 71 against the second work 72 on the image 61 displayed on the display unit 39 .
- the operator can judge whether or not the pressing direction of the workpiece is appropriate. For example, when the direction in which the first work is pressed is set as the movement direction of the first work, the operator can determine whether the pressing direction is appropriate.
- the operator can change the position and posture of the robot 1 while viewing the image 61 .
- the worker may find it difficult to see the part that the actual work is in contact with.
- the work may be small and it may be difficult to check the posture of the work being pressed. Even in such a case, the operator can adjust the direction in which one work presses the other while viewing the image displayed on the display unit.
- the display control unit 54 can display arbitrary information regarding the pressing direction of the workpiece and the position of the contact point on the display unit.
- the direction of movement or the position of the contact point may be displayed in coordinate values of a predetermined coordinate system.
- the pressing direction of the workpiece may be displayed by coordinate values of the W-axis, P-axis, and R-axis in the reference coordinate system.
- FIG. 10 shows a schematic diagram of the second robot device according to the present embodiment.
- a first workpiece 71 is fixed to a workbench 75 in the second robot device 6 .
- a second work 72 is gripped by the hand 2 and moved by the second robot device 6 .
- the second robot device 6 moves the work 72 as indicated by an arrow 91 to fit the work 71 into the recess 72 a of the work 72 .
- force control is performed to control the position and attitude of the robot 1 so that the force applied to the tip of the first workpiece 71 in a predetermined direction is reduced. implement.
- the position and attitude of the robot 1 are controlled so that the force applied to the tip of the work 71 in a direction other than the moving direction and the moment applied to the tip of the work 71 approach zero.
- a workpiece tip point is set on the end surface 71b of the first workpiece 71 in order to perform force control.
- the direction of movement of the second work 72 relative to the first work 71 is set.
- FIG. 11 shows a schematic diagram of the second robot device when the corner of the second work is brought into contact with the first work.
- FIG. 12 shows an enlarged perspective view of a portion where the second work contacts the first work.
- the operator manually drives the robot device to press the second work 72 as the contact member against the first work 71 .
- the operator brings the corner 72b of the second work 72 into contact with the end surface 71b of the work 71 .
- the operator brings the corner portion 72b into contact with the front end point of the work in the actual fitting operation.
- the parameter calculation unit 51 acquires the force detected by the force sensor 24 corresponding to each pressing direction.
- the parameter calculator 51 calculates the movement direction of the second work 72 and the position of the work tip point of the first work 71 based on the forces corresponding to the plurality of pressing directions.
- the robot 1 In the first control for pressing the second work 72 , the robot 1 is driven to press the second work 72 in the predetermined pressing direction indicated by the arrow 94 .
- the robot 1 is driven so as to press the second work 72 against the first work 71 along the moving direction (moving direction) in the actual fitting work.
- the position and posture of the robot 1 are changed so as to press the second work 72 in a direction parallel to the direction in which the central axis of the first work 71 extends.
- the force sensor 24 detects the force applied to the second work 72 while the second work 72 is being pressed against the first work 71 .
- the robot 1 is driven so as to press the second work 72 in the predetermined pressing direction indicated by the arrow 95 .
- a direction different from the first pressing direction is adopted as the second pressing direction.
- the force sensor 24 detects the force applied to the second work 72 while the second work 72 is being pressed against the first work 71 .
- FIG. 13 shows a schematic diagram of a robot apparatus for explaining the parameters set by pressing the corner of the second work against the end surface of the first work. 2, 12, and 13, moving direction calculator 52 of parameter calculator 51 can calculate the pressing direction based on the force in the orthogonal axis direction in the sensor coordinate system. The movement direction calculator 52 sets one pressing direction calculated based on the output of the force sensor 24 to the movement direction indicated by the arrow 66 .
- the position calculator 53 of the parameter calculator 51 calculates the line of action based on the pressing direction and the moment about the orthogonal axis in the sensor coordinate system.
- the position calculator 53 calculates a plurality of lines of action corresponding to a plurality of pressing directions based on the output of the force sensor 24 . Then, the position calculator 53 can calculate the position of the workpiece tip point 65 of the workpiece 71 based on the plurality of lines of action.
- the parameter calculation unit 51 calculates the moving direction and the position of the tip point of the workpiece in the sensor coordinate system 82 when the second workpiece 72 is in contact with the first workpiece 71 .
- the parameter calculation unit 51 calculates the workpiece end point 65 represented by the sensor coordinate system 82 based on the position and posture of the robot when the second workpiece 72 is in contact with the first workpiece 71.
- the position and movement direction are transformed into the position and movement direction of the workpiece tip point 65 represented by the reference coordinate system 81 .
- the parameter calculator 51 sets the position and movement direction of the workpiece tip point 65 in the reference coordinate system 81 in the operation program 46 .
- the operator can set the position and movement direction of the workpiece tip point 65 displayed on the display unit 39 in the operation program 46 . In this way, when the second work 72 is fitted to the first work 71 fixed to the workbench, the work end point 65 and the moving direction are set to the first work 71 fixed to the workbench. can be set.
- the operator sets the initial position and attitude of the second work 72 when performing the control of fitting the work 72 to the work 71 .
- the operator places the concave portion 72a of the work 72 right above the work 71 as shown in FIG.
- the operator adjusts the position and attitude of the robot so that the central axis 71a of the workpiece 71 substantially coincides with the central axis 72aa of the recess 72a.
- the parameter calculation unit 51 or the operator sets the position and orientation of the robot at this time in the operation program 46 as the initial position and orientation of the robot at which the work fitting control is started.
- the motion control unit 43 starts force control after driving the robot 1 to the initial position and posture.
- the motion control unit 43 drives the robot 1 to move the second work in the movement direction.
- Forces detected by the force sensor 24 forces in the X-, Y-, and Z-axis directions and moments in the W-, P-, and R-axis directions
- Forces detected by the force sensor 24 are calculated based on the robot's position and orientation at the workpiece end point 65. is converted into a force acting on
- the motion control unit 43 controls the position and attitude of the robot so that the force applied to the workpiece tip point 65 in a predetermined direction is within a predetermined determination range. In this manner, the control device 4 can perform force control based on the workpiece tip point 65 and the movement direction indicated by the arrow 66 .
- the display control unit 54 of the parameter calculation unit 51 displays an image on the display unit 39 when the robot 1 is being driven so as to press the second work 72 toward the first work 71 .
- the display control unit 54 acquires the moving direction calculated by the moving direction calculating unit 52 and displays the moving direction superimposed on the image of the robot 1 . Further, the display control unit 54 may display the work tip point 65 calculated by the position calculation unit 53 as an image.
- the second work is used as the contact member that contacts the first work, but it is not limited to this form.
- the contact member any member including a corner portion having a tip can be adopted.
- a jig including corners may be moved by a robot device.
- FIG. 14 shows a schematic diagram of a third robot device according to the present embodiment.
- the third robot device 7 differs from the first robot device 5 in the position where the force sensor 24 is arranged.
- the force sensor 24 is arranged between the second work 72 supported by the workbench 75 and the surface of the workbench 75 .
- the force sensor 24 is fixed to the workbench 75 via the support member 26 .
- a second work 72 is fixed to a workbench 75 via a force sensor 24 and a support member 26 .
- control similar to the parameter setting procedure of the first robot device 5 can be performed.
- Fig. 15 shows a schematic diagram of the third robot device when pressing the first work against the second work.
- the operator brings the workpiece tip point of the first workpiece 71 into contact with the corner 72 b of the second workpiece 72 .
- the first work 71 is pressed toward the second work 72 as indicated by an arrow 92 .
- the first work 71 is pressed toward the second work in a direction parallel to the moving direction of the first work 71 in the actual fitting work.
- the force sensor 24 detects force applied to the second work 72 .
- the first work 71 is pressed toward the second work 72 as indicated by an arrow 93 .
- the pressing direction indicated by arrow 93 is different from the pressing direction indicated by arrow 92 .
- the force sensor 24 detects force applied to the second work 72 .
- the movement direction calculator 52 calculates the pressing direction acting on the second workpiece 72 based on the forces (forces in the X-axis, Y-axis, and Z-axis directions) detected by the force sensors 24 .
- the pressing direction acting on the second work 72 corresponds to the direction in which the first work 71 is pressed against the second work 72 .
- the moving direction calculator 52 sets the pressing direction indicated by the arrow 92 as the moving direction.
- the position calculation unit 53 calculates the position of the workpiece tip point based on the pressing direction and the force detected by the force sensor 24 (moments in the directions of the W-axis, P-axis, and R-axis).
- the position calculator 53 calculates a plurality of lines of action based on a plurality of pressing directions, and calculates the position of the tip point of the workpiece based on the plurality of lines of action.
- the parameter calculator 51 calculates the moving direction and the position of the contact point in the sensor coordinate system 82 .
- the parameter calculator 51 acquires the position and orientation of the robot 1 when the workpiece tip point of the first workpiece 71 is in contact with the corner of the second workpiece.
- the parameter calculation unit 51 calculates the moving direction and the work end point position represented by the sensor coordinate system 82, and calculates the moving direction and the work end point position expressed by the flange coordinate system 83. to the position of The parameter calculator 51 or the operator can set the moving direction and the position of the tip point of the tool represented by the flange coordinate system 83 in the operation program 46 as parameters for force control.
- FIG. 16 shows a perspective view of a third robot apparatus for explaining the tip point of the workpiece and the movement direction of the workpiece calculated by the parameter calculation unit.
- a movement direction indicated by a workpiece tip point 65 and an arrow 66 is set for the first workpiece 71 gripped by the hand 2, as in the case of the first robot device 5.
- FIG. The workpiece tip point 65 and the moving direction move together with the first workpiece 71 .
- the motion control unit 43 adjusts the force detected by the force sensor 24 to the work end point 65 based on the position and orientation of the robot 1. can be converted into a force acting on Also in the third robot device 7, the same force control as in the first robot device 5 can be implemented. In other words, force control can be performed based on the tip point 65 of the workpiece and the moving direction indicated by the arrow 66 when performing the operation of fitting the first workpiece 71 into the recess 72a.
- any jig having corners may be fixed to the workbench as a contact member instead of the second work. Also in this case, it is possible to perform control to press the first workpiece against the corner of the jig.
- the contact member is fixed to the workbench and the robot moves the first workpiece, but the configuration is not limited to this.
- the first workpiece may be fixed to the workbench and the contact member may be moved by the robot.
- the first work may be fixed to the workbench via the force sensor, and the second work may be gripped and moved by the robot device.
- force sensor 24 detects the force applied to the first workpiece.
- the parameter setting procedure it is possible to set the position and movement direction of the workpiece tip point based on the output of a force sensor fixed to the workbench.
- FIG. 17 shows a schematic diagram of a fourth robot device according to the present embodiment.
- a torque sensor 25 is arranged as a force detector.
- a plurality of torque sensors 25 are arranged on the drive shafts of the plurality of joints 18 of the robot 1 .
- torque sensors 25 are arranged on all six drive shafts. Each torque sensor 25 detects torque around the drive shaft of the joint 18 .
- a torque sensor 25 is arranged in the fourth robot device 8.
- the output of the torque sensor 25 is transmitted to the parameter calculator 51 .
- the parameter calculator 51 calculates the position of the tip end point of the first workpiece 71 and the moving direction of the first workpiece 71 based on the force (torque around the drive shaft) output from each torque sensor 25. .
- FIG. 18 shows a schematic diagram of the robot device when the first work is in contact with the corner of the second work.
- the operator brings the workpiece tip point of the first workpiece 71 into contact with the corner of the second workpiece 72 .
- the robot 1 is driven to press the first work 71 toward the second work 72 as indicated by an arrow 92 .
- the pressing direction indicated by the arrow 92 corresponds to the moving direction of the first work 71 in the actual fitting work.
- the torque sensor 25 detects torque around each drive shaft.
- the movement direction calculator 52 can calculate the pressing direction of the first work 71 indicated by the arrow 92 based on the outputs of the plurality of torque sensors 25 .
- the movement direction calculator 52 can calculate the pressing direction using the principle of force balance or virtual work.
- An arrow 92 corresponds to a line of action on which there is a contact point as the work tip point.
- the movement direction calculator 52 can set the pressing direction of the first workpiece 71 indicated by the arrow 92 as the movement direction.
- the pressing direction can be acquired in the control of pressing the workpiece in one direction, but the position of the front end point of the workpiece (the position of the contact point where the workpieces come into contact with each other) cannot be calculated.
- the fourth robot device 8 in order to specify the position of the contact point arranged on the straight line in the pressing direction, the workpiece 71 is pressed against the workpiece 72 from another direction and the position of the tip point of the workpiece is calculated.
- control is performed to press the first workpiece 71 from a direction different from the first pressing direction.
- the robot 1 is driven to press the first work 71 against the corner 72 b of the second work 72 in the direction indicated by the arrow 93 .
- the movement direction calculator 52 calculates the pressing direction of the first workpiece 71 indicated by an arrow 93 based on the outputs of the plurality of torque sensors 25 .
- Arrow 93 corresponds to the line of action where the contact point exists.
- the position calculation unit 53 calculates the intersection of the two pressing directions pressing the work 71 as the contact point where the first work 71 contacts the second work 72 . In other words, the position calculator 53 calculates the position of the intersection of the arrows 92 and 93 as the position of the workpiece tip point 65 . In this way, by performing control to press the first workpiece against the corner from two or more directions, the intersection point of the vectors in the pressing directions can be calculated as the position of the front end point of the workpiece.
- FIG. 19 shows a schematic diagram of a fourth robotic device describing parameters generated for force control.
- the parameter calculator 51 of the fourth robot device 8 calculates the position of the workpiece tip point 65 and the movement direction indicated by the arrow 66 in the flange coordinate system.
- the motion control unit 43 calculates the force acting on the work tip point 65 based on the outputs of the plurality of torque sensors 25 .
- the motion control section 43 can perform force control based on the position and moving direction of the workpiece tip point 65 .
- the robot 1 supports the first work 71 and inserts the first work 71 into the recess 72a of the second work 72, but is not limited to this form.
- the first work 71 may be fixed to the workbench 75 and the fourth robot device 8 may move the second work 72 .
- the work tip point and movement direction are set to the first work.
- the operator moves the contact member such as the second workpiece 72 with a robot, and moves the corner of the contact member to the workpiece tip point of the first workpiece 71. come into contact with
- the parameter calculation unit 51 can calculate the position and movement direction of the workpiece tip point based on the output of the torque sensor 25 .
- the measurement was performed by changing the direction of pressing the other workpiece without changing the posture of one workpiece, but the configuration is not limited to this.
- the posture of the first work with respect to the second work can be changed in the second control of pressing the first work.
- the position of the tip point of the workpiece can be calculated based on the line of action corresponding to the pressing direction.
- control for fitting a cylindrical work is shown, but the control of the present embodiment can be applied to works of any shape.
- the control of fitting one work to another work is shown, but the present invention is not limited to this form.
- the control device of the present embodiment can be applied to any work of moving one work toward another work, such as aligning works or searching for a hole.
- the control of the present embodiment can be applied to work that requires force control because the work contacts other objects when the robot moves the work.
- the work of fitting is not limited to the work of inserting a workpiece into a concave portion or a hole, but includes, for example, the work of arranging a gear at a predetermined position while matching the phases of the teeth of the gear.
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
Abstract
Description
2 ハンド
4 制御装置
9 把持部材
15 手首部
16 フランジ
18 関節部
24 力覚センサ
25 トルクセンサ
37 教示操作盤
39 表示部
40 制御装置本体
43 動作制御部
51 パラメータ算出部
52 移動方向算出部
53 位置算出部
54 表示制御部
61 画像
65 ワーク先端点
66 矢印
71,72 ワーク
71b 端面
72b 角部
75 作業台
81 基準座標系
82 センサ座標系
83 フランジ座標系
85,86 作用線
99M 矢印
Claims (10)
- ロボットにて第1のワークを第2のワークに向かって移動する時に力制御を行うためのパラメータを算出する制御装置であって、
角部を有する接触部材に前記ロボットにて第1のワークを接触させた時に、第1のワークおよび接触部材のうち一方に加わる力を検出する力検出器と、
力制御を行う時に第2のワークに対して第1のワークを移動する移動方向および力制御の制御点となるワーク先端点の位置を算出するパラメータ算出部と、を備え、
前記力検出器は、前記ロボットにて第1のワークのワーク先端点を接触部材の角部に接触させて、第1のワークを予め定められた押付け方向に沿って押し付けている期間中に力を検出し、
前記パラメータ算出部は、複数の押付け方向にて第1のワークを接触部材に押付けた時に、それぞれの押付け方向に対応して前記力検出器にて検出される力を取得し、複数の押付け方向に対応する力に基づいて第1のワークの移動方向および第1のワークのワーク先端点の位置を算出する、制御装置。 - ロボットにて第2のワークを第1のワークに向かって移動する時に力制御を行うためのパラメータを算出する制御装置であって、
前記ロボットにて角部を有する接触部材を第1のワークに接触させた時に、第1のワークおよび接触部材のうち一方に加わる力を検出する力検出器と、
力制御を行う時に第1のワークに対して第2のワークを移動する移動方向および力制御の制御点となるワーク先端点の位置を算出するパラメータ算出部と、を備え、
前記力検出器は、前記ロボットにて接触部材の角部を第1のワークのワーク先端点に接触させて、接触部材を予め定められた押付け方向に沿って押し付けている期間中に力を検出し、
前記パラメータ算出部は、複数の押付け方向にて接触部材を第1のワークに押付けた時に、それぞれの押付け方向に対応して前記力検出器にて検出される力を取得し、複数の押付け方向に対応する力に基づいて第2のワークの移動方向および第1のワークのワーク先端点の位置を算出する、制御装置。 - 前記力検出器は、前記ロボットまたはワークを支持する作業台に取り付けられた6軸の力覚センサを含む、請求項1または2に記載の制御装置。
- 前記ロボットは、フランジを有する手首部を含み、
前記力検出器は、フランジと作業ツールとの間に配置されている、請求項1から3のいずれか一項に記載の制御装置。 - 前記力検出器は、作業台に支持されるワークと作業台の表面との間に配置されている、請求項1から3のいずれか一項に記載の制御装置。
- 前記ロボットは、複数の駆動軸を有する多関節ロボットであり、
前記力検出器は、それぞれの駆動軸に配置されたトルクセンサを含む、請求項1または2に記載の制御装置。 - 前記ロボットの画像を表示する表示部と、
表示部に表示する画像を制御する表示制御部と、を備え、
前記表示制御部は、第1のワークおよび接触部材のうち一方の部材を他の部材に向かって押し付けるように前記ロボットを駆動している期間中に、前記パラメータ算出部にて算出される押付け方向を取得し、前記ロボットの画像に押付け方向を重ねて表示する、請求項1から6のいずれか一項に記載の制御装置。 - 前記パラメータ算出部は、それぞれの押付け方向に対応して検出器にて検出される力に基づいて、ワーク先端点が存在する作用線を算出し、複数の作用線の交点をワーク先端点として算出する、請求項1から7のいずれか一項に記載の制御装置。
- 前記パラメータ算出部は、それぞれの押付け方向に対応して検出器にて検出される力に基づいて、ワーク先端点が存在する作用線を算出し、複数の作用線のうち少なくとも一つの作用線が他の作用線と交わらない場合に、複数の作用線からの距離に基づいてワーク先端点の位置を算出する、請求項1から7のいずれか一項に記載の制御装置。
- 前記ロボットの動作を制御する動作制御部を備え、
前記動作制御部は、前記パラメータ算出部にて算出されるワーク先端点の位置および移動方向に基づいて、作業台に固定されているワークに対して前記ロボットにて支持されるワークを嵌合させる制御を実施する、請求項1から9のいずれか一項に記載の制御装置。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE112022000796.6T DE112022000796T5 (de) | 2021-03-30 | 2022-03-23 | Steuervorrichtung zur berechnung von parametern zur steuerung von position und pose eines roboters |
CN202280021089.2A CN116997445A (zh) | 2021-03-30 | 2022-03-23 | 计算用于控制机器人的位置和姿势的参数的控制装置 |
US18/283,058 US20240165822A1 (en) | 2021-03-30 | 2022-03-23 | Control device for calculating parameters for controlling position and posture of robot |
JP2023511071A JP7477716B2 (ja) | 2021-03-30 | 2022-03-23 | ロボットの位置および姿勢を制御するパラメータを算出する制御装置 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021057646 | 2021-03-30 | ||
JP2021-057646 | 2021-03-30 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2022210186A1 true WO2022210186A1 (ja) | 2022-10-06 |
Family
ID=83456660
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2022/013623 WO2022210186A1 (ja) | 2021-03-30 | 2022-03-23 | ロボットの位置および姿勢を制御するパラメータを算出する制御装置 |
Country Status (6)
Country | Link |
---|---|
US (1) | US20240165822A1 (ja) |
JP (1) | JP7477716B2 (ja) |
CN (1) | CN116997445A (ja) |
DE (1) | DE112022000796T5 (ja) |
TW (1) | TW202239551A (ja) |
WO (1) | WO2022210186A1 (ja) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011194499A (ja) * | 2010-03-18 | 2011-10-06 | Fanuc Ltd | ロボットを用いた嵌合装置 |
JP2012157946A (ja) * | 2011-02-01 | 2012-08-23 | Fanuc Ltd | 力センサの出力に基づいてロボットのダイレクトティーチをおこなうロボット教示装置 |
JP2014128857A (ja) * | 2012-12-28 | 2014-07-10 | Yaskawa Electric Corp | ロボット教示システムおよびロボット教示方法 |
JP2016221642A (ja) * | 2015-06-02 | 2016-12-28 | セイコーエプソン株式会社 | ロボット、ロボット制御装置、ロボット制御方法およびロボットシステム |
JP2017001122A (ja) * | 2015-06-08 | 2017-01-05 | ファナック株式会社 | ロボットと力の表示機能を備えたロボット制御装置 |
JP2018015855A (ja) * | 2016-07-29 | 2018-02-01 | セイコーエプソン株式会社 | ロボット制御装置、ロボット、及びロボットシステム |
JP2018118340A (ja) * | 2017-01-24 | 2018-08-02 | ファナック株式会社 | 力制御押付装置を備えたロボットシステム |
WO2022009765A1 (ja) * | 2020-07-08 | 2022-01-13 | ファナック株式会社 | ロボット制御装置 |
-
2022
- 2022-03-21 TW TW111110335A patent/TW202239551A/zh unknown
- 2022-03-23 JP JP2023511071A patent/JP7477716B2/ja active Active
- 2022-03-23 DE DE112022000796.6T patent/DE112022000796T5/de active Pending
- 2022-03-23 US US18/283,058 patent/US20240165822A1/en active Pending
- 2022-03-23 WO PCT/JP2022/013623 patent/WO2022210186A1/ja active Application Filing
- 2022-03-23 CN CN202280021089.2A patent/CN116997445A/zh active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011194499A (ja) * | 2010-03-18 | 2011-10-06 | Fanuc Ltd | ロボットを用いた嵌合装置 |
JP2012157946A (ja) * | 2011-02-01 | 2012-08-23 | Fanuc Ltd | 力センサの出力に基づいてロボットのダイレクトティーチをおこなうロボット教示装置 |
JP2014128857A (ja) * | 2012-12-28 | 2014-07-10 | Yaskawa Electric Corp | ロボット教示システムおよびロボット教示方法 |
JP2016221642A (ja) * | 2015-06-02 | 2016-12-28 | セイコーエプソン株式会社 | ロボット、ロボット制御装置、ロボット制御方法およびロボットシステム |
JP2017001122A (ja) * | 2015-06-08 | 2017-01-05 | ファナック株式会社 | ロボットと力の表示機能を備えたロボット制御装置 |
JP2018015855A (ja) * | 2016-07-29 | 2018-02-01 | セイコーエプソン株式会社 | ロボット制御装置、ロボット、及びロボットシステム |
JP2018118340A (ja) * | 2017-01-24 | 2018-08-02 | ファナック株式会社 | 力制御押付装置を備えたロボットシステム |
WO2022009765A1 (ja) * | 2020-07-08 | 2022-01-13 | ファナック株式会社 | ロボット制御装置 |
Also Published As
Publication number | Publication date |
---|---|
JPWO2022210186A1 (ja) | 2022-10-06 |
CN116997445A (zh) | 2023-11-03 |
US20240165822A1 (en) | 2024-05-23 |
DE112022000796T5 (de) | 2023-11-23 |
JP7477716B2 (ja) | 2024-05-01 |
TW202239551A (zh) | 2022-10-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110997249B (zh) | 作业机器人和作业机器人的控制方法 | |
US5880956A (en) | Lead-through robot programming system | |
US11465288B2 (en) | Method of controlling robot | |
US20180111266A1 (en) | Control device, robot, and robot system | |
US11161249B2 (en) | Robot control apparatus and robot system | |
CN106493711B (zh) | 控制装置、机器人以及机器人*** | |
CN110524536B (zh) | 机器人控制装置以及机器人*** | |
JP7187765B2 (ja) | ロボット制御装置 | |
US11123864B2 (en) | Motion teaching apparatus, robot system, and motion teaching method | |
US11679508B2 (en) | Robot device controller for controlling position of robot | |
US11331810B2 (en) | Device, method and program for estimating weight and position of gravity center of load by using robot | |
CN112368116A (zh) | 附接到机器人臂的有效载荷的估计 | |
CN109129525B (zh) | 机器人的负载重心位置推定装置及负载重心位置推定方法 | |
CN112405566A (zh) | 机器人控制装置 | |
JP4054984B2 (ja) | ロボットの制御装置および制御方法 | |
WO2019017416A1 (ja) | 作業用ロボット、作業用ロボットの制御方法 | |
WO2022210186A1 (ja) | ロボットの位置および姿勢を制御するパラメータを算出する制御装置 | |
JPH06143171A (ja) | ロボット | |
JP3577124B2 (ja) | 力制御ロボットを用いて嵌合データを取得する方法 | |
CN116852359A (zh) | 一种基于机器人手持示教装置的tcp快速标定的装置及方法 | |
JP2022084259A (ja) | 情報処理装置、情報処理方法、ロボットシステム、測定システム、ロボットシステムを用いた物品の製造方法、制御プログラム及び記録媒体 | |
JP7481579B2 (ja) | ロボット装置またはワークに作用する外力の許容値を算出する計算装置およびロボットの制御装置 | |
JP2021024075A (ja) | ロボットの位置を制御するロボット装置の制御装置 | |
JP2000094370A (ja) | ロボットの作業表面の傾き測定方法およびその測定装置 | |
CN112643683B (zh) | 示教方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 22780401 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2023511071 Country of ref document: JP Kind code of ref document: A |
|
WWE | Wipo information: entry into national phase |
Ref document number: 202280021089.2 Country of ref document: CN |
|
WWE | Wipo information: entry into national phase |
Ref document number: 18283058 Country of ref document: US |
|
WWE | Wipo information: entry into national phase |
Ref document number: 112022000796 Country of ref document: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 22780401 Country of ref document: EP Kind code of ref document: A1 |