WO2020246808A1 - 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 - Google Patents
피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 Download PDFInfo
- Publication number
- WO2020246808A1 WO2020246808A1 PCT/KR2020/007224 KR2020007224W WO2020246808A1 WO 2020246808 A1 WO2020246808 A1 WO 2020246808A1 KR 2020007224 W KR2020007224 W KR 2020007224W WO 2020246808 A1 WO2020246808 A1 WO 2020246808A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- joint
- manipulator
- link
- actuator
- axis
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 33
- 230000000694 effects Effects 0.000 claims abstract description 12
- 239000012636 effector Substances 0.000 claims description 30
- 238000006073 displacement reaction Methods 0.000 claims description 11
- 230000005484 gravity Effects 0.000 claims description 3
- 206010028980 Neoplasm Diseases 0.000 claims 5
- 201000011510 cancer Diseases 0.000 claims 5
- 230000033001 locomotion Effects 0.000 description 29
- 238000010586 diagram Methods 0.000 description 18
- 230000006870 function Effects 0.000 description 10
- 238000004891 communication Methods 0.000 description 9
- 238000005498 polishing Methods 0.000 description 8
- 230000007246 mechanism Effects 0.000 description 6
- 239000011159 matrix material Substances 0.000 description 5
- 230000008569 process Effects 0.000 description 5
- 230000004044 response Effects 0.000 description 5
- 230000005540 biological transmission Effects 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000005520 cutting process Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000007935 neutral effect Effects 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 238000003754 machining Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 206010023230 Joint stiffness Diseases 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 239000000470 constituent Substances 0.000 description 1
- 230000005489 elastic deformation Effects 0.000 description 1
- 238000007730 finishing process Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000005381 potential energy Methods 0.000 description 1
- 238000007781 pre-processing Methods 0.000 description 1
- 238000003825 pressing Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000003746 surface roughness Effects 0.000 description 1
- 230000001052 transient 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
- B25J11/00—Manipulators not otherwise provided for
- B25J11/005—Manipulators for mechanical processing tasks
-
- 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/1638—Programme controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia
-
- 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/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/023—Cartesian coordinate type
- B25J9/026—Gantry-type
-
- 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/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/04—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
- B25J9/046—Revolute coordinate type
-
- 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/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/106—Programme-controlled manipulators characterised by positioning means for manipulator elements with articulated links
- B25J9/1065—Programme-controlled manipulators characterised by positioning means for manipulator elements with articulated links with parallelograms
-
- 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
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41426—Feedforward of torque
Definitions
- the present disclosure (disclosure) relates to a manipulator for finishing work and a control method thereof.
- finishing or surface finishing was considered an incentive, requiring long production times and high costs.
- finishing or surface finishing
- the automatic finishing process is becoming more important.
- Industrial robots have a decisive drawback that their rigidity is considerably low, especially under machining forces, which leads to significant path deviation.
- some industrial robots adopt a closed servo system that limits the user's accessibility, so special end-effectors are required to prevent disturbances in passive or active mechanisms.
- the present disclosure provides a manipulator that provides a stable torque to perform a stable finishing operation and a control method thereof.
- a manipulator for a finishing operation comprising: a base; An arm including a plurality of links, a plurality of joints connecting the plurality of links, and a plurality of actuators for generating rotation of at least some of the plurality of joints; And a processor configured to determine a driving torque of each of the plurality of actuators in consideration of the self-weight effect of the manipulator, and control the plurality of actuators based on the determined driving torque.
- an embodiment of the present disclosure provides a manipulator, wherein one side of the arm is fixed to the base and further includes a parallelogram link set having a parallelogram structure.
- the arm further includes a first link, a second link, a first actuator, a second actuator, a first joint, and a second joint
- the parallelogram link set is one side double A link
- the double link includes the first link and the second link parallel to each other
- the first link is connected to the base through the first joint rotated by the first actuator
- the second link The two links provide a manipulator, which is connected with the base through the second joint rotated by the second actuator.
- an embodiment of the present disclosure provides a manipulator in which each rotation axis of the first joint and the second joint is parallel to a working surface and disposed in the same straight line, and is dynamically decoupled.
- the second joint provides a lever effect for the arm by the parallelogram structure, and the processor controls feed forward torque through the second actuator. To perform, provide a manipulator.
- an embodiment of the present disclosure provides a manipulator, wherein the feed forward torque control does not involve position feedback on the arm and force feedback on the arm.
- the arm further includes a third joint, a third actuator, and a swing arm link, and the swing arm link is not connected to the base of the parallelogram link set.
- a manipulator is provided, which is connected through the third joint at an end of the side that is not formed, and the third joint rotates along an axis of rotation in a direction perpendicular to the working surface by the third actuator.
- the arm further includes a fourth joint, a fifth joint, a fourth actuator, a fifth actuator, a hand link, and an end effector, and the hand link Is connected through the fourth joint at the end of the swing arm link, the fourth joint is rotated along a rotation axis in the direction of the hand link by the fourth actuator, and the end effector is at the end of the hand link.
- a manipulator is provided, which is connected through the fifth joint, the fifth joint rotates along an axis of rotation parallel to the working surface and perpendicular to the direction of the hand link by the fifth actuator.
- the feed forward torque of the second actuator is Wherein g 2 is the gravity of the manipulator at the second joint, q is a displacement vector of the first to fifth joints, q 2 is the displacement of the second joint, and h is the manipulator.
- the constraint function, ⁇ provides a manipulator, which is an external force vector in the end effector.
- an embodiment of the present disclosure provides a manipulator, wherein the base is connected to a gantry structure.
- a wider working range may be secured by the manipulator adopting a swing arm structure.
- FIG. 1 is a diagram illustrating a finishing machine according to an embodiment of the present disclosure.
- FIG. 2 is a block diagram illustrating a manipulator according to an embodiment of the present disclosure.
- 3 to 5 are diagrams illustrating a 5-axis manipulator according to an embodiment of the present disclosure.
- FIG. 6 is a diagram illustrating a method of controlling a manipulator based on an inverse kinematic model according to an embodiment of the present disclosure.
- FIG. 7 is a diagram illustrating a simulation process for a manipulator according to an embodiment of the present disclosure.
- FIG. 8 is a diagram illustrating a constrained motion of a manipulator according to an embodiment of the present disclosure.
- FIG. 9 is a diagram illustrating feed forward torque control of a manipulator according to an embodiment of the present disclosure.
- FIG. 10 is a control block diagram of a manipulator according to an embodiment of the present disclosure.
- 11 is a diagram showing a force control result according to compliance control when there is no polishing wheel.
- FIG. 12 is a view showing a force control result according to feed-forward torque control when there is no polishing wheel.
- FIG. 13 is a diagram comparing a conventional force feedback control and a feed forward control proposed in the present disclosure.
- finishing machine 1 is a view showing a finishing machine (finishing machine 1) according to an embodiment of the present disclosure.
- the finishing machine 1 may include a manipulator 100, a gantry structure 200, a first slide table 300, and the like. .
- the gantry structure 200 shown in FIG. 1 does not include a moving part that moves in the x-axis direction, and instead, a second sliding table 400 that moves in the x-axis direction and mounts a workpiece may be provided. have.
- the present disclosure is not limited thereto.
- the gantry structure 200 of the finishing machine 1 may include a moving part (eg, a wheel) moving in the x-axis direction.
- the manipulator 100 may be connected to the gantry structure 200 through the first slide table 300, and the height or the z-axis position may be adjusted according to the movement of the first slide table 300.
- the first slide table 300 may move in the y-axis direction in the gantry structure 200.
- the translational axes using the gantry structure 200 have high stiffness compared to the heavy industrial robot and may provide a wider work space.
- the manipulator 100 may perform a surface finishing operation on a work by using a rotating tool such as an electro-spindle or a pneumatic-spindle mounted on an end-effector. Because the manipulator 100 has different compliance characteristics depending on the position and orientation of the end effector, the finishing operation can be performed only in a limited area that produces acceptable compliance in a specified posture.
- a rotating tool such as an electro-spindle or a pneumatic-spindle mounted on an end-effector.
- the manipulator 100 may be positioned in a desired working area in the x, y, and z axes to satisfy both the acceptable compliance range and the operating position of the work piece.
- FIG. 2 is a block diagram illustrating a manipulator 100 according to an embodiment of the present disclosure.
- a manipulator 100 may include a communication unit 110, a memory 120, an actuator 130, a processor 190, and the like.
- the communication unit 110 may transmit and receive data to and from an external device (not shown) that controls the manipulator 100 or the finishing machine 1 using wired/wireless communication technology.
- the communication unit 110 may receive a control signal or a control profile from an external device (not shown).
- GSM Global System for Mobile communication
- CDMA Code Division Multi Access
- LTE Long Term Evolution
- 5G Wireless LAN
- WLAN Wireless-Fidelity
- Bluetooth Bluetooth
- RFID Radio Frequency Identification
- IrDA Infrared Data Association
- ZigBee ZigBee
- NFC Near Field Communication
- the memory 120 may store data supporting various functions of the manipulator 100.
- the memory 120 may store various application programs driven by the manipulator 100 and data and instructions for the operation of the manipulator 100.
- the memory 120 may store firmware used to drive the manipulator 100, an application program used to control the actuator 130, a control profile, and the like.
- the actuator 130 generates the movement of the manipulator 100 and may include at least one or more.
- the actuator 130 may also be referred to as a motor.
- the actuator 130 may generate a movement that rotates around a predetermined axis, or may generate a translational movement along a predetermined path.
- the actuator 130 may be operated in consideration of a self-weight effect on the manipulator 100. That is, the actuator 130 may operate with the strength of the torque determined in consideration of the posture of the manipulator 100 and the weight accordingly.
- the manipulator 100 may be a five-axis manipulator.
- the five-axis manipulator 100 may have the structures shown in FIGS. 3 and 4.
- the sensor unit 140 may acquire state information of the manipulator 100 and state information (eg, motion information, force information, etc.) of the manipulator 100 using various sensors. For example, the sensor unit 140 may acquire an angle, a rotational speed, and a rotational speed of a rotational tool mounted on an end effector by the operation of the actuator 130.
- state information eg, motion information, force information, etc.
- the sensor unit 140 may acquire an angle, a rotational speed, and a rotational speed of a rotational tool mounted on an end effector by the operation of the actuator 130.
- the sensor unit 140 may acquire the shape of the work, the location of the work, the state of the work, and surface information of the work by using various sensors.
- Sensors included in the sensor unit 140 include proximity sensors, illuminance sensors, acceleration sensors, magnetic sensors, gyro sensors, inertial sensors, RGB sensors, IR sensors, fingerprint recognition sensors, ultrasonic sensors, optical sensors, microphones, lidars, and radars. Etc.
- the processor 190 may control the actuator 130 by driving an application program stored in the memory 120.
- the processor 190 may control the actuator 130 based on the control signal.
- the processor 190 may receive a control signal from an external device through the communication unit 110 or may receive a control signal through an input unit (not shown).
- the processor 190 may generate a control signal for the actuator 130 in consideration of state information of the actuator 130.
- the processor 190 may adjust a set control signal in consideration of sensor information acquired through the sensor unit 140.
- the processor 190 may also be referred to as a controller or a motion controller.
- 3 to 5 are views showing a 5-axis manipulator 100 according to an embodiment of the present disclosure.
- the five-axis manipulator 100 may include five motors or actuators, and accordingly, five axes 311, 312, 313, 314, and 315 Various movements may be possible.
- the term “motor” and the term “actuator” may be used interchangeably.
- a motor or actuator that generates rotation about the first joint 511 may be referred to as a first motor or a first actuator.
- a motor or actuator that generates rotation about the second joint 512 is a second motor or a second actuator
- a motor or actuator that generates rotation about the third joint 513 is a third motor or a third actuator
- a motor or actuator that generates rotation about the fourth joint 514 may be referred to as a fourth motor or a fourth actuator
- a motor or actuator that generates rotation about the fifth joint 515 may be referred to as a fifth motor or a fifth actuator. have.
- the rotation axis of the first joint 511 is the first shaft 311
- the rotation axis of the second joint 512 is the second axis 312
- the rotation axis of the third joint 513 is the third axis 313
- the rotation axis of the fourth joint 514 may be referred to as a fourth axis 314
- the rotation axis of the fifth joint 515 may be referred to as a fifth axis 315.
- the terms shafts 311 to 315 and the terms joints 511 to 515 may be used interchangeably.
- first joint 511, the second joint 512, the third joint 513, the fourth joint 514, and the fifth joint 515 are equipped with actuators to actively rotate.
- This is a controlled active joint, and other joints 521, 522 and 523 may be passive joints in which rotation is not actively controlled.
- the first manual joint 521, the second manual joint 522, and the third manual joint 523 play an important role in supporting a load and maintaining an accurate posture during a finishing operation.
- some or all of the active joints 511, 512, 513, 514, 515 and the passive joints 521, 522, 523 may have an angular contact ball bearing structure.
- the angular contact ball bearing may have various angular contact ball bearing structures such as single row angular contact ball bearings, double row angular contact ball bearings, etc., and may have a structure in which two or more angular contact ball bearings are assembled into a pair. .
- Angular contact ball bearings have high rigidity in the axial and radial directions and can effectively reduce vibrations generated during machining operations.
- the first joint 511, the second joint 512, and the third passive joint 523 may have an angular contact ball bearing structure.
- the 5-axis manipulator 100 includes links having a parallelogram structure (hereinafter, a parallelogram link set, 412), and two vertices (or one side of the parallelogram structure) on one side (z-axis direction) of the parallelogram structure. ) May be fixed to a predetermined position of the base 411 of the 5-axis manipulator 100.
- the first joint 511 and the second joint are located at a position corresponding to one vertex in the arm direction or the x-axis direction. 512) can be deployed.
- the arm direction may be an x-axis direction.
- the first actuator corresponding to the first joint 511 and the second actuator corresponding to the second joint 512 are decoupled and may be kinematically separated from each other.
- the first axis 311 and the second axis 312 may be parallel to the y-axis direction.
- the first shaft 311 and the second shaft 312 may be positioned on the same straight line. That is, the first shaft 311 and the second shaft 312 may be in a direction parallel to the work surface.
- the xy plane may mean a plane parallel to the work plane, and the z-axis may mean an axis in a direction perpendicular to the work plane or an axis in a vertical direction.
- the x-axis may mean an arm direction, a work direction, or a front direction of the manipulator 100 in a neutral state.
- the arm direction may mean a direction of a hand link 414 to be described later.
- the parallelogram link set 412 includes a first link 531 connected to the first joint 511 and a second link 532 connected to the second joint 512, and the first link 531 and the second
- the links 532 are parallel and have a double link structure, and are located on the same side of the parallelogram in the parallelogram link set 412.
- Each of the first link 531 and the second link 532 is connected to the base 411 at only one end by a first joint 511 and a second joint 512 corresponding to each other.
- the second actuator corresponding to the second joint 512 may be connected or disposed to the base 411 of the 5-axis manipulator 100, thereby reducing the load of the arm by the second actuator and reducing the second joint.
- the drive torque of 512 can be maximized.
- a link not connected to the base 411 has a link structure protruding in a direction extending in the arm direction or the x-axis direction, and the protruding link has a third joint 513 Can be placed. That is, among the links included in the parallelogram link set 412, the third joint 513, the second manual joint 522, and the third manual joint 523 may be disposed on the links not connected to the base 411. have.
- the swing arm link 413 may be connected to the parallelogram link set 412 through a third joint 513.
- the third axis 313 may be parallel to the z-axis direction. That is, the third axis 313 may be in a direction perpendicular to the work surface.
- a fourth joint 514 may be disposed at an end of the swing arm link 413 in the arm direction.
- the hand link 414 may be connected to the swing arm link 413 through the fourth joint 514.
- the fourth axis 314 may be parallel to the y-axis direction when the swing arm link 413 is in a neutral state. That is, the fourth axis 314 may be the direction of the hand link 414.
- a fifth joint 515 may be disposed on the hand link 414.
- the end effector may be connected to the hand link 414 through the fifth joint 515.
- the fifth axis 315 may be parallel to the y-axis direction when the swing arm link 413 and the hand link 414 are in a neutral state. That is, the fifth axis 315 may be in a direction parallel to the work surface and perpendicular to the fourth axis 314.
- the position of the end effector in the z-axis direction (more specifically, the position in the xz plane) may be adjusted by rotation in the first joint 511 and the second joint 512, and the third joint 513
- the position in the xy plane may be adjusted by rotation at, and the direction may be determined by rotation at the fourth joint 514 and the fifth joint 515.
- Table 1 shows examples of the numerical values of the links of the 5-axis manipulator 100
- Table 2 shows the characteristics of the motor of the 5-axis manipulator 100.
- the numerical values shown in [Table 1] and [Table 2] are only examples, and the values may vary according to various embodiments.
- the 5-axis manipulator 100 adopts a parallelogram mechanism so that a center of mass may be disposed near the base 411 of the manipulator 100. This is because the center of mass is directly related to the performance of the actuator, and as the center of mass approaches the base 411, the load imposed on each joint is reduced. In addition, this is because the parallelogram mechanism has a kinematically and dynamically separated structure. As described above, the positions of the first joint 511 and the second joint 512 in the xz plane can be determined.
- the five-axis manipulator 100 adopts a swing arm mechanism to operate in a plane Planar operation) can improve dynamic response
- the third motor or the third actuator may rotate the swing arm link 413 which rotates about the third axis 313 parallel to the plane direction (xy plane).
- the 5-axis manipulator 100 may employ a feed forward torque control function using a self-weight effect.
- the function of the second motor corresponding to the second joint 512 in the 5-axis manipulator 100 may be switched to a feed forward torque control function rather than a position control function.
- a normal force pressing the work piece by the end effector may be kept constant according to the weight of the link and the set torque value. Accordingly, the 5-axis manipulator 100 can overcome limitations of robot feedback control such as joint rigidity, response speed, and bandwidth, and perform finishing processing.
- the 5-axis manipulator 100 may utilize the weight of a link or an arm as a reaction force against a processing force by using the self-weight effect.
- the total weight of the manipulator 100 excluding the base may be about 25 kg.
- the base of the manipulator 100 is mounted on the z-axis slide of the finishing machine 1 or the first sliding table 300, and may include a mounting jig.
- the motion of the manipulator 100 is determined by the driving torque of each actuator 130, which can be calculated by a kinetic energy function and a potential energy function of the system.
- an inverse kinematic model of the manipulator 100 may be applied to a motion control process.
- the compliance of the manipulator 100 may be given as in [Equation 1] to [Equation 4] below.
- M is the moment of inertia matrix
- C is the Coriolis and centrifugal force matrix
- G is the gravitational vector
- ⁇ is the external force vector including the Jacobian of the manipulator 100
- ⁇ is a series of actuators required to generate a specific motion ( 130) may mean a torque vector.
- q denotes a displacement vector of each axis or joint
- K q denotes a joint rotation stiffness matrix
- ⁇ q denotes a deformation value of each joint due to joint stiffness.
- Equation 1 means that the manipulator compliance is influenced by a rotational displacement generated by a joint torque
- Equation 2 may mean a difference value of torque due to the presence or absence of an external force.
- Cartesian coordinates obtained from the joint coordinates can be expressed as follows [Equation 3].
- ⁇ X may denote a transformation vector of an end effector
- C X may denote a Cartesian space compliance matrix.
- the overall compliance consists of a manipulator and a wheel. If the wheel stiffness is high, the manipulator can be controlled by a position control method that produces accurate machine depth. A defined wheel can be recommended when removing tool marks while force control is achieved so as not to damage the original pre-machined shape. [Table 3] below shows the z-axis overall compliance for each wheel use case.
- FIG. 6 is a diagram illustrating a control method of the manipulator 100 based on an inverse kinematic model according to an embodiment of the present disclosure.
- FIG. 6 shows an example of a control method of the manipulator 100 involving feedforward torque control.
- a separate PC 610 may transmit a position command and a torque command to the motion controller 620.
- the motion controller 620 may mean the processor 190 shown in FIG. 2.
- FIG. 6 illustrates an embodiment in which the manipulator 100 operates under the control of a separate PC 610, but the present disclosure is not limited thereto. That is, in one embodiment, the processor 180 may perform both the role of the PC 610 shown in FIG. 6 and the role of the motion controller 620.
- the motion controller 620 may transmit a real-time torque value to the servo 630 based on motion information (or motion information 661) of the robot 650, a position command and a torque command.
- the robot 650 may refer to an end effector of the manipulator 100 or a rotating tool mounted on the end effector.
- the motion information 661 of the robot 650 may mean posture information of the robot 650, and the posture information of the robot 650 may mean posture of each motor or each joint.
- the servo 630 may perform position control and torque control on the motor 640 based on the real-time torque value received from the motion controller 620 and the motion information 661 of the robot 650.
- the robot 650 may be controlled by the operation of the motor 640.
- the motor or actuator may be used as a term collectively referring to the servo 630 and the motor 640. That is, even if simply referred to as a motor or an actuator, this may mean a motor 640 including a servo 630.
- the PC 610 may perform calibration 681 for the control of the motor 640 using the motion information 661 and the force information 671 of the robot 650.
- the calibration for the control of the motor 640 may include position correction, dynamics correction, torsional compliance, bearing compliance, and the like.
- the PC 610 performs preprocessing 691 using a kinematic model, a dynamic mode, a finishing excition, and a compliance model in the calibration 681 process. I can. Further, the PC 610 may improve the control process of the manipulator 100 based on the calibration 681 and the preprocess 691.
- the PC 610 may adjust K and correct the torque based on the force information 671.
- K can mean mass and length parameters in the inverse kinematic model.
- FIG. 6 illustrates a method of controlling the operation of the manipulator 100 by the processor 180 of the manipulator 100 generating a control signal for the actuator 130
- an external device such as a PC 610
- the processor 180 of the manipulator 100 The actuator 130 may be controlled based on the generated control signal or control command.
- FIG. 7 is a diagram illustrating a simulation process for the manipulator 100 according to an embodiment of the present disclosure.
- the simulation for the manipulator 100 may include an online calculation 710 and an offline calculation 720.
- the dynamic performance of the manipulator 100 can be estimated by employing a virtual controller, servo drive, and hardware.
- the motion controller part includes a PID control loop and a filter for frequency response
- the servo drive part includes a motor mechanism
- the hardware part includes a rigid manipulator 100 and transmission with gear ratio and transmission efficiency. May include mechanisms.
- the online calculation 710 may represent the actual communication between the manipulator 100 and the controller as an encoder signal and a current.
- Offline calculation 720 may represent virtual communication.
- FIG. 8 is a diagram illustrating a constrained motion of the manipulator 100 according to an embodiment of the present disclosure.
- the polishing wheel attached to the end effector of the manipulator 100 is constrained and moved by a given work surface and is affected by a reaction force generated by a cutting force. . Therefore, it is necessary to calculate a driving torque to cope with a given constrained path rather than a forward kinematics motion based on surface shape data.
- the surface constraint can be assumed as shown in [Equation 6] below.
- a constraint condition can be defined as shown in [Equation 7] below through a relationship between the trajectory ⁇ 811 shown in FIG. 8 and the kinematic element of the manipulator 100.
- h is a function indicating a constraint condition for the manipulator 100
- h j is a function indicating a constraint condition when the j-axis direction is constrained.
- T denotes a base-to-end effector transformation matrix
- t denotes a tangent vector of the end effector
- n denotes a normal vector of the end effector.
- FIG 9 is a diagram illustrating feed forward torque control of the manipulator 100 according to an embodiment of the present disclosure.
- the cutting force mainly depends on the second joint 512 due to the parallelogram structure of the manipulator 100.
- the feed forward torque control method may be employed to maintain a constant repulsive force in a constrained operation.
- the position and force of the joints 511 to 515 may be simultaneously controlled in correspondence with the estimated driving torque for the joints 511 to 515 according to the force control rule.
- This control method has the advantage that force control without delay time is possible, and force errors are not affected by dynamic motion from the surface in a non-constrained direction.
- generating smooth and uniform torque from the actuator is more suitable than generating frequent force control responses by sensor feedback.
- the feed forward torque control in the form of a gravity feed can be employed for indirect force control, and the force of the end effector is the deadweight of the manipulator 100 including the tool and the driving torque of the second joint 512 Can be determined by
- ⁇ ⁇ can mean the driving torque of the unconstrained manipulator
- ⁇ h can mean the driving torque only by the constraint.
- the driving torque of the unconstrained manipulator can be expressed as [Equation 13] below based on [Equation 1], because the kinetic energy term can be neglected because the joint motion is very slow.
- the driving torque of the wrapping operation can be generated as a model as shown in [Equation 14] and [Equation 15], and the gradient term of the constraint is obtained by [Equation 10] and [Equation 11] can do.
- the 5-axis manipulator 100 is designed so that the second joint 512 provides a lever effect, and accordingly, the second joint 512 uses the weight of the manipulator 100 in a plane. It has a structure optimized to respond to the repulsive force of Therefore, the feed forward torque control rule according to the following [Equation 16] can be applied to only the second joint 512. That is, only the second actuator corresponding to the second joint 512 or the second joint 512 can perform feed forward torque control by receiving the converted control voltage by the motion controller or processor 190, Feed forward torque control does not involve position feedback and force feedback.
- the feed forward torque by the second joint 512 is as follows [Equation 17] It can be simplified as k 1 and k 2 are control gains. The higher the gain, the greater the torque generated by the actuator, and the greater the force generated by the end effector. Gain values can be determined and adjusted by prior experimentation defining the relationship between the end effector force and the gain value.
- FIG. 10 is a control block diagram of the manipulator 100 according to an embodiment of the present disclosure.
- the driving torque of the second actuator corresponding to the second joint 512 is generated through the feed forward torque model, and the feedback control mode may be terminated. If the force control is terminated, the feed forward control mode is terminated, and the feedback control mode may be switched to move to the target point. Except for the second actuator, the remaining actuators can only maintain position control irrespective of the control situation.
- 11 is a diagram showing a force control result according to compliance control when there is no polishing wheel.
- FIG. 11 shows the end effector force
- (b) of FIG. 11 shows a command voltage for transmission of motor control torque.
- FIG. 12 is a view showing a force control result according to feed-forward torque control when there is no polishing wheel.
- FIG. 12 shows the end effector force
- (b) of FIG. 12 shows a command voltage for transmission of motor control torque.
- the driving voltage of the motor has a value between -6V and +6V, and generates 100% of the rated torque.
- the force applied according to the feed forward torque control proposed in the present disclosure is determined by the driving torque of the second actuator, the first actuator (or the first motor) and the fifth actuator (or the fifth motor)
- the driving torque of can be maintained constant by focusing only on the position control of the manipulator 100.
- the feed forward torque control has the advantage of helping to suppress the vibration of the manipulator 100 due to a rapid dynamic cutting force.
- FIG. 13 is a diagram comparing a conventional force feedback control and a feed forward control proposed in the present disclosure.
- the feed forward control proposed in the present disclosure shows an unrestricted and indirect force control mode of feedback vibration.
- the end effector of the manipulator 100 moved from a position of 100 mm to a position of 200 mm in the x-axis according to the linear interpolation method.
- a force error may occur in an unstable posture due to a compliance error due to a change in the posture of the manipulator 100.
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Forklifts And Lifting Vehicles (AREA)
Abstract
Description
링크 | l 1 | l 2 | l 3 | l 4 | l 5 | l a | l b |
길이(mm) | 330 | 210 | 203.5 | 96.5 | 62.5 | 130 | 330 |
질량(kg) | 5.67 | 3.55 | 1.57 | 2.05 | - | 0.85 | 1.53 |
모터 | 제1 모터 | 제2 모터 | 제3 모터 | 제4 모터 | 제5 모터 |
출력 (W) | 600 | 200 | 400 | 200 | 100 |
질량 (kg) | 5.4 | 1.8 | 2.25 | 1.8 | 1.1 |
Case | w/o wheel | #24 | #80 | #120 | #180 | #400 |
compliance c z (μm/N) | 4.8 | 12.2 | 35.6 | 42.5 | 83.8 | 108.9 |
Claims (13)
- 피니싱 작업을 위한 매니퓰레이터(manifulator)에 있어서,베이스(base);복수의 링크(link), 상기 복수의 링크를 연결하는 복수의 조인트(joint) 및 상기 복수의 조인트 중에서 적어도 일부의 조인트의 회전을 발생시키는 복수의 액츄에이터(actuator)를 포함하는 암(arm); 및상기 매니퓰레이터의 자중 효과를 고려하여 상기 복수의 액츄에이터 각각의 구동 토크(driving torque)를 결정하고, 상기 결정된 구동 토크에 기초하여 상기 복수의 액츄에이터를 제어하는 프로세서를 포함하는, 매니퓰레이터.
- 청구항 1에 있어서,상기 암은일 변이 상기 베이스에 고정되고 평행사변형 구조를 갖는 평행사변형 링크 세트를 더 포함하는, 매니퓰레이터.
- 청구항 2에 있어서,상기 암은제1 링크, 제2 링크, 제1 액츄에이터, 제2 액츄에이터, 제1 조인트 및 제2 조인트를 더 포함하고,상기 평행사변형 링크 세트는일 변이 이중 링크이고,상기 이중 링크는서로 평행한 상기 제1 링크와 상기 제2 링크를 포함하고,상기 제1 링크는상기 제1 액츄에이터에 의해 회전하는 상기 제1 조인트를 통해 상기 베이스와 연결되고,상기 제2 링크는상기 제2 액츄에이터에 의해 회전하는 상기 제2 조인트를 통해 상기 베이스와 연결되는, 매니퓰레이터.
- 청구항 3에 있어서,상기 제1 조인트와 상기 제2 조인트는각각의 회전 축이 작업면에 평행하고 동일한 일직선에 배치되고, 동역학적으로 디커플링되는(decoupled), 매니퓰레이터.
- 청구항 4에 있어서,상기 제2 조인트는상기 평행사변형 구조에 의해 상기 암에 대한 지렛대 효과를 제공하고,상기 프로세서는상기 제2 액츄에이터를 통해 피드 포워드 토크 제어(feed forward torque control)를 수행하는, 매니퓰레이터.
- 청구항 5에 있어서,상기 피드 포워드 토크 제어는상기 암에 대한 위치 피드백과 상기 암에 대한 포스 피드백(force feedback)을 수반하지 않는, 매니퓰레이터.
- 청구항 5에 있어서,상기 암은제3 조인트, 제3 액츄에이터 및 스윙 암 링크(swing arm link)를 더 포함하고,상기 스윙 암 링크는상기 평행사변형 링크 세트의 상기 베이스에 연결되지 않은 변의 말단에서 상기 제3 조인트를 통해 연결되고,상기 제3 조인트는상기 제3 액츄에이터에 의해 상기 작업면에 수직한 방향의 회전 축을 따라 회전하는, 매니퓰레이터.
- 청구항 7에 있어서,상기 암은제4 조인트, 제5 조인트, 제4 액츄에이터, 제5 액츄에이터, 핸드 링크(hand link) 및 엔드 이펙터(end effector)를 더 포함하고,상기 핸드 링크는상기 스윙 암 링크의 말단에서 상기 제4 조인트를 통해 연결되고,상기 제4 조인트는상기 제4 액츄에이터에 의해 상기 핸드 링크의 방향의 회전 축을 따라 회전하고,상기 엔드 이펙터는상기 핸드 링크의 말단에서 상기 제5 조인트를 통해 연결되고,상기 제5 조인트는상기 제5 액츄에이터에 의해 상기 작업면과 평행하고 상기 핸드 링크의 방향과 수직한 회전 축을 따라 회전하는, 매니퓰레이터.
- 청구항 1에 있어서,상기 베이스는갠트리 구조물(gantry structure)에 연결되는, 매니퓰레이터.
- 피니싱 작업을 위한 매니퓰레이터(manifulator)의 제어 방법에 있어서,상기 매니퓰레이터의 자중 효과를 고려하여 상기 매니퓰레이터에 포함된 복수의 액츄에이터 각각의 구동 토크를 결정하는 단계; 및상기 결정된 구동 토크에 기초하여 상기 복수의 액츄에이터를 제어하는 단계를 포함하는, 제어 방법.
- 청구항 11에 있어서,상기 매니퓰레이터는베이스(base) 및 암(arm)을 포함하고,상기 암은일 변이 상기 베이스에 고정되고 평행사변형 구조를 갖는 평행 사변형 링크 세트를 포함하고,상기 평행사변형 링크 세트는일 변이 이중 링크이고,상기 이중 링크는서로 평행한 상기 제1 링크와 상기 제2 링크를 포함하고,상기 제1 링크는상기 제1 액츄에이터에 의해 회전하는 상기 제1 조인트를 통해 상기 베이스와 연결되고,상기 제2 링크는상기 제2 액츄에이터에 의해 회전하는 상기 제2 조인트를 통해 상기 베이스와 연결되고,상기 제1 조인트와 상기 제2 조인트는각각의 회전 축이 작업면에 평행하고 동일한 일직선에 배치되고, 동역학적으로 디커플링되는(decoupled), 제어 방법.
- 청구항 12에 있어서,상기 제2 조인트는상기 평행사변형 구조에 의해 상기 암에 대한 지렛대 효과를 제공하고,상기 복수의 액츄에이터를 제어하는 단계는상기 제2 액츄에이터를 통해 피드 포워드 토크 제어(feed forward torque control)를 수행하는 단계를 포함하는, 제어 방법.
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US17/616,593 US11745342B2 (en) | 2019-06-03 | 2020-06-03 | Manipulator for finishing work, and control method therefor |
KR1020217018105A KR20210083362A (ko) | 2019-06-03 | 2020-06-03 | 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 |
KR1020237043717A KR20240000643A (ko) | 2019-06-03 | 2020-06-03 | 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 |
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR20190065060 | 2019-06-03 | ||
KR10-2019-0065060 | 2019-06-03 | ||
US201962924807P | 2019-10-23 | 2019-10-23 | |
US62/924,807 | 2019-10-23 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2020246808A1 true WO2020246808A1 (ko) | 2020-12-10 |
Family
ID=73652999
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/KR2020/007224 WO2020246808A1 (ko) | 2019-06-03 | 2020-06-03 | 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 |
Country Status (3)
Country | Link |
---|---|
US (1) | US11745342B2 (ko) |
KR (2) | KR20240000643A (ko) |
WO (1) | WO2020246808A1 (ko) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7141847B2 (ja) * | 2018-05-11 | 2022-09-26 | 川崎重工業株式会社 | 撓み量推定装置、ロボット制御装置、及び撓み量推定方法 |
KR102642410B1 (ko) | 2020-12-24 | 2024-03-04 | 부산대학교 산학협력단 | 원자로 내부 해체를 위한 힘 기반 임피던스 제어 시스템 및 방법 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100814185B1 (ko) * | 2005-10-18 | 2008-03-14 | 세이코 엡슨 가부시키가이샤 | 평행 링크 기구 및 산업용 로봇 |
KR101683526B1 (ko) * | 2015-02-12 | 2016-12-07 | 현대자동차 주식회사 | 중력 보상 링키지 유니트 |
KR101724490B1 (ko) * | 2015-12-02 | 2017-04-07 | 기아자동차 주식회사 | 협업로봇을 이용한 차량 생산시스템 및 생산방법 |
US10029369B1 (en) * | 2017-06-09 | 2018-07-24 | Precise Automation, Inc. | Collaborative robot |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102009007026A1 (de) | 2009-02-02 | 2010-08-05 | Kuka Roboter Gmbh | Steuerung und Steuerungsverfahren für einen Manipulator |
US9119655B2 (en) * | 2012-08-03 | 2015-09-01 | Stryker Corporation | Surgical manipulator capable of controlling a surgical instrument in multiple modes |
US10173323B2 (en) * | 2017-06-09 | 2019-01-08 | Precise Automation, Inc. | Collaborative robot |
-
2020
- 2020-06-03 KR KR1020237043717A patent/KR20240000643A/ko active Application Filing
- 2020-06-03 KR KR1020217018105A patent/KR20210083362A/ko active Application Filing
- 2020-06-03 WO PCT/KR2020/007224 patent/WO2020246808A1/ko active Application Filing
- 2020-06-03 US US17/616,593 patent/US11745342B2/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100814185B1 (ko) * | 2005-10-18 | 2008-03-14 | 세이코 엡슨 가부시키가이샤 | 평행 링크 기구 및 산업용 로봇 |
KR101683526B1 (ko) * | 2015-02-12 | 2016-12-07 | 현대자동차 주식회사 | 중력 보상 링키지 유니트 |
KR101724490B1 (ko) * | 2015-12-02 | 2017-04-07 | 기아자동차 주식회사 | 협업로봇을 이용한 차량 생산시스템 및 생산방법 |
US10029369B1 (en) * | 2017-06-09 | 2018-07-24 | Precise Automation, Inc. | Collaborative robot |
Non-Patent Citations (1)
Title |
---|
KIM, JONG-JAE ET AL.: "Design of manipulator for gantry-type finishing machine", EUSPEN, 18TH INTERNATIONAL CONFERENCE & EXHIBITION, June 2018 (2018-06-01), Venice, XP055768811 * |
Also Published As
Publication number | Publication date |
---|---|
US11745342B2 (en) | 2023-09-05 |
US20220226992A1 (en) | 2022-07-21 |
KR20240000643A (ko) | 2024-01-02 |
KR20210083362A (ko) | 2021-07-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP1755838B1 (en) | Parallel kinematic robot and method for controlling this robot | |
JP7093342B2 (ja) | ロボット支援による表面加工機械 | |
EP1863734B1 (en) | Parallel robot | |
WO2020246808A1 (ko) | 피니싱 작업을 위한 매니퓰레이터 및 그의 제어 방법 | |
WO2017022893A1 (ko) | 작업공간에서의 강성 개선을 위한 여자유도 로봇 제어 시스템, 방법, 및 상기 방법을 실행시키기 위한 컴퓨터 판독 가능한 프로그램을 기록한 기록 매체 | |
JP4289506B2 (ja) | 四自由度パラレルロボット | |
KR101182600B1 (ko) | 실린더 형태의 큰 작업영역을 갖는 병렬형 로봇기구 | |
KR20210095574A (ko) | 공작기계 | |
WO2014123054A1 (ja) | ロボット制御装置及びロボット制御方法 | |
WO2020149502A1 (ko) | 확장된 작업영역을 갖는 병렬로봇 | |
JP4984114B2 (ja) | 空間3自由度パラレル機構及び該空間3自由度パラレル機構を用いた多軸制御工作機械 | |
JP2009023056A (ja) | パラレルメカニズムを備えた工作機械 | |
CN218875470U (zh) | 作业装置及其碰撞保护结构 | |
CN115502960B (zh) | 末端组件、作业装置及其控制方法 | |
JP2024088431A (ja) | 遠隔操作システム | |
JP7414426B2 (ja) | ロボットシステム | |
US20230381978A1 (en) | Processing machine with active vibration reduction | |
JP2004529000A (ja) | 平行位置決め機構、特に、機械加工および/またはマニュピレーションおよび/または測定用の平行位置決め機構 | |
JPH07205072A (ja) | 複数ロボットの協調制御装置 | |
KR19990028177A (ko) | 3차원상에서 위치 및 자세를 제어하기 위한 병렬기구 구조 | |
JPH0197588A (ja) | 多関節ロボット | |
JPH0413579A (ja) | 無反動装置 | |
JPH0890462A (ja) | パラレルリンクマニピュレータ | |
KR100225870B1 (ko) | 균형 설계된 수직 다관절 로봇 | |
Lee et al. | Design and control of a prototype platform manipulator for workholding and workhandling applications |
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: 20819396 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 20217018105 Country of ref document: KR Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
32PN | Ep: public notification in the ep bulletin as address of the adressee cannot be established |
Free format text: NOTING OF LOSS OF RIGHTS PURSUANT TO RULE 112(1) EPC (EPO FORM 1205A DATED 22/04/2022) |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 20819396 Country of ref document: EP Kind code of ref document: A1 |