A control device of robot arm including a pressure sensing module and a control module is provided. The pressure sensing module, disposed on an operating portion of a robot arm, has a touch-sensing surface for detecting an operation command applied to the touch-sensing surface. The control module receives at least a pressure sensing signal outputted by the pressure sensing module and outputs a motor driving signal to the robot arm in response to the operation command. The touch-sensing surface includes a first touch-sensing region and a second touch-sensing region. The first touch-sensing region is for defining a first reference coordinate system satisfying a translational motion mode. The second touch-sensing region is for defining a second reference coordinate system satisfying a rotational motion mode. The control module controls the robot arm according to the operation command.
|
1. A control device of a robot arm, comprising:
a pressure sensing module disposed on an operating portion of a robot arm and having a touch-sensing surface for detecting an operation command applied to the touch-sensing surface, wherein the touch-sensing surface comprises a first touch-sensing region and a second touch-sensing region, the first touch-sensing region is for defining a first reference coordinate system related to a translational motion mode, and the second touch-sensing region is for defining a second reference coordinate system related to a rotational motion mode; and
a control module configured to receive at least a pressure sensing signal outputted by the pressure sensing module and to output a motor driving signal to the robot arm in response to the operation command, wherein the control module controls the robot arm to move towards a target position according to the operation command.
21. A method for performing direct teaching on a robot arm, comprising:
performing initialization on a robot arm and outputting a motor driving signal to the robot arm;
recording a moving trajectory of the robot arm to obtain a current azimuth and posture of the robot arm;
switching operating modes of the robot arm when the moving trajectory of the robot arm deviates from a target position, wherein the operating modes comprise a compliance teaching mode and a touch operating mode, wherein under the touch operating mode, a position control on an end effector of the robot arm is performed on the robot arm according to an operation command from a pressure sensing module;
performing a joint posture control on the robot arm manually under the compliance teaching mode;
correcting the moving trajectory of the robot arm by performing the position control on the end effector of the robot arm, or performing the position control on the end effector of the robot arm firstly and the joint posture control subsequently, or performing the joint posture control on the robot arm firstly and the position control on the end effector subsequently;
terminating recording the moving trajectory of the robot arm; and
reproducing a teaching trajectory of the robot arm to move the robot arm to the target position.
12. A robot arm teaching system, comprising:
a pressure sensing module disposed on an operating portion of a robot arm and having a touch-sensing surface for detecting an operation command applied to the touch-sensing surface, wherein the touch-sensing surface comprises a first touch-sensing region and a second touch-sensing region, the first touch-sensing region is for defining a first reference coordinate system related to a translational motion mode, and the second touch-sensing region is for defining a second reference coordinate system related to a rotational motion mode; and
a control module configured to receive at least a pressure sensing signal outputted by the pressure sensing module and to output a motor driving signal to the robot arm in response to the operation command, wherein the control module comprises:
a joint-motor controller for generating a set of motor torque signals for moving the robot arm according to the operation command;
a mode-switching module for switching operating modes of the robot arm, wherein the operating modes of the robot arm comprise a compliance teaching mode and a touch operating mode; and
a plurality of joint-motor encoders disposed on each joint of the robot arm, wherein the joint-motor encoders generate a set of joint angle signals according to a moving trajectory of the robot arm under the compliance teaching mode;
wherein, the control module controls the robot arm to move towards a target position according to the operation command.
2. The control device according to
3. The control device according to
4. The control device according to
5. The control device according to
6. The control device according to
7. The control device according to
8. The control device according to
9. The control device according to
10. The control device according to
11. The control device according to
13. The teaching system according to
14. The teaching system according to
15. The teaching system according to
16. The teaching system according to
17. The teaching system according to
18. The teaching system according to
19. The teaching system according to
20. The teaching system according to
|
This application claims the benefit of U.S. provisional application Ser. No. 62/374,074, filed Aug. 12, 2016 and Taiwan application Serial No. 105137642, filed Nov. 17, 2016, the disclosures of which are incorporated by references herein in its entirety.
The disclosure relates in general to a robot arm, and more particularly to a control device of a robot arm, a teaching system and a method using the same.
Traditionally, a robot controller of an industrial robot is provided with servo controllers for controlling the positions of the motors driving the motion of the manipulator. Meanwhile, each joint motor transmits coordinate signals to the robot controller to determine whether the trajectory of the robot arm matches an expectation or not. If the trajectory of the robot arm does not match the expectation, the user normally edit the commands over and over again through programming languages or application programs, and edit the movement path of the robot arm according to the user's commands.. However, such manner is tedious and time consuming, and lacks intuitive programmability. That is, there is no intuitive input interface existing between the robot arm and the user, and conventional programming system does not allow the user to edit the movement path of the robot arm through intuitive operations. These are the current problems that need to be resolved in the design and manufacturing of robot arms.
The disclosure is directed to a control device of a robot arm, a teaching system and a method using the same allowing the operator to edit the movement path of the robot arm through lead-through and intuitive operation, and therefore achieving intuitive control.
The disclosure is directed to a control device of a robot arm, a teaching system and a method using the same capable of allowing the operator to choose the compliance modes of the robot arm, which includes compliance teaching manually and changing the posture of the robot arm (for rough positioning) and/or position control on the end effector of the robot arm (for precision positioning).
According to one embodiment, a control device of a robot arm is provided. The control device of the robot arm includes a pressure sensing module and a control module is provided. The pressure sensing module is disposed on an operating portion of a robot arm and has a touch-sensing surface for detecting an operation command applied to the touch-sensing surface. The control module receives at least a pressure sensing signal outputted by the pressure sensing module and outputs a motor driving signal to the robot arm in response to the operation command. The touch-sensing surface includes a first touch-sensing region and a second touch-sensing region. The first touch-sensing region is for defining a first reference coordinate system satisfying a translational motion mode, and the second touch-sensing region is for defining a second reference coordinate system satisfying a rotational motion mode. The control module controls the robot arm to move towards a target position according to the operation command.
According to another embodiment, a robot arm teaching system is provided. The robot arm teaching system includes a pressure sensing module and a control module is provided. The pressure sensing module is disposed on an operating portion of a robot arm and has a touch-sensing surface for detecting an operation command applied to the touch-sensing surface. The touch-sensing surface includes a first touch-sensing region and a second touch-sensing region. The first touch-sensing region is for defining a first reference coordinate system satisfying a translational motion mode, and the second touch-sensing region is for defining a second reference coordinate system satisfying a rotational motion mode. The control module is configured to receive at least a pressure sensing signal outputted by the pressure sensing module and to output a motor driving signal to the robot arm in response to the operation command. The control module includes a joint-motor controller, a mode-switching module and a plurality of joint-motor encoders. The joint-motor controller generates a set of motor torque signals for translating or rotating the end effector of the robot arm according to the operation command. The control module controls the robot arm to move towards a target position according to the operation command. The mode-switching module is for switching operating modes of the robot arm, wherein the operating modes of the robot arm include a compliance teaching mode and a touch operating mode. The joint-motor encoders are disposed on the joints of the robot arm, and, under the compliance teaching mode, generate a set of joint angle signals according to the moving trajectory of the robot arm.
According to an alternative embodiment, a method for performing direct teaching on a robot arm is provided. The method includes following steps: performing initialization on a robot arm and outputting a motor driving signal to the robot arm; recording a moving trajectory of the robot arm to obtain the current position and posture of the robot arm; switching operating modes of the robot arm when the moving trajectory of the robot arm deviates from a target position, wherein the operating modes comprise a compliance teaching mode and a touch operating mode. Under the touch operating mode, a position control on an end effector of the robot arm is performed on the robot arm according to an operation command on the touch-sensing regions; performing a joint posture control on the robot arm manually under the compliance teaching mode; correcting the moving trajectory of the robot arm by performing the position control on the end effector of the robot arm, or performing the position control on the end effector of the robot arm firstly and the joint posture control subsequently, or performing the joint posture control on the robot arm firstly and the position control on the end effector subsequently; terminating recording the moving trajectory of the robot arm; and reproducing a teaching trajectory of the robot arm to move the robot arm to the target position.
The above and other aspects of the disclosure will become better understood with regard to the following detailed description of the embodiment(s). The following description is made with reference to the accompanying drawings.
The present disclosure is described with a number of embodiments.
However, the embodiments are for exemplification purpose only, not for limiting the scope of protection of the present disclosure.
Refer to
Refer to
In an embodiment, the array circuit 113 may include a plurality of first wires 114 arranged in parallel along the X-axis direction and a plurality of second wires 115 arranged in parallel along Y-axis direction. Each first wire 114 electrically connects the upper electrode layer 116 of each pressure sensing element 111 arranged in a straight line along the X-axis direction, and each second wire 115 electrically connects the lower electrode layer 118 of each pressure sensing element 111 arranged in a straight line along the Y-axis direction to form a touch-sensing surface 112. The touch-sensing surface 112 formed by using other touch sensing technology or proximity sensing technology can be used in the control device 100 of the disclosure, and the disclosure is not limited thereto.
The pressure sensing module 110 detects whether an object touches the robot arm 101. The object can be such as an operator or a machine operating in collaboration with the robot arm 101. The pressure sensing module 110 can be electro-mechanically integrated with the robot arm 101 and used as a tactile skin of the robot arm 101. Furthermore, the control module 130 can be electrically connected to the pressure sensing module 110 through the signal line inside the robot arm 101 or can wirelessly receive the signal outputted by the pressure sensing module 110.
For example, when the operator touches the pressure sensing module 110 with his/her finger(s), the pressure sensing module 110 generates a pressure sensing signal according to an operation command applied to the touch-sensing surface 112. The control module 130 converts the pressure sensing signal into a motor driving signal for controlling the end effector 108 of the robot arm 101 to move towards a target position. Moreover, the motion parameters (amount of displacement and/or amount of rotation) of the motor driving signal can be determined according to the translation signal or the rotation signal generated on single-touch point P, a set of touch points P, or a combination thereof. The motion parameters are used to control the joint motors 102, the forearm 103 and the rear arm 104 of the robot arm 101 to move horizontally, vertically, forward, backward, upward or downward or rotate.
Refer to
Refer to
Refer to
The first touch-sensing region 112a is for defining a first reference coordinate system satisfying a translational motion mode. That is, when detecting an operation command applied to the first touch-sensing region 112a, the control module 130 controls the end effector 108 of the robot arm 101 to perform a translational motion. Besides, the second touch-sensing region 112b is for defining a second reference coordinate system satisfying a rotational motion mode. That is, when an operation command applied to the second annular touch-sensing region 112b is detected, the control module 130 controls the end effector 108 of the robot arm 101 to perform a rotational motion.
As indicated in
Refer to
Refer to
Refer to
Refer to
Refer to
Referring to
Referring to
Moreover, the joint-motor encoder 136 is disposed on each joint of the robot arm 101. Under the compliance teaching mode, the joint-motor encoders 136 generate a set of joint angle signals according to the moving trajectory of the robot arm 101 to record the current position and posture of each joint. Furthermore, the teaching controller 138 connects the joint-motor encoders 136, and, under the compliance teaching mode, the teaching controller 138 stores the set of joint angle signals generated by the joint-motor encoders 136. And the teaching controller 138, under the touch operating mode, also can store the motor torque signal of each joint to record the coordinate information of the teaching point (that is, joint posture). When the moving trajectory of the robot arm 101 needs to be reproduced, the teaching controller 138 converts the set of joint angle signals and the motor torque signals into a motor driving signal capable of reproducing the moving trajectory of the robot arm 101.
Refer to
Refer to
Refer to
It can be understood from above descriptions that the operator can give an operation command to the robot arm 101 through the pressure sensing module 110, and use the control module 130 to convert the touch sensing signal into the torque required at each joint of the robot arm 101 or compensate the torque (the gravity compensation torque or the friction compensation torque) so that the control module 130 can control the azimuth and posture of each joint and realize the collaboration between man and the robot arm 101 in the industrial applications. Moreover, the teaching system and teaching method of the disclosure combine the pressure sensing module 110 and the joint-motor encoder 136 to perform the precision positioning teaching and/or the rough positioning teaching, so that the operator can flexibly adjust the compliance mode of the robot arm 101 and resolve the problems of positioning accuracy being insufficient and motor resistance being too large when the teaching system performs direct teaching.
It will be apparent to those skilled in the art that various modifications and variations can be made to the disclosed embodiments. It is intended that the specification and examples be considered as exemplary only, with a true scope of the disclosure being indicated by the following claims and their equivalents.
Yu, Hung-Hsiu, Chen, Chang-Yi, Su, Jui-Yiao, Liu, Yan-Chen, Chen, Ching-Shun, Wu, Cheng-Li
Patent | Priority | Assignee | Title |
10895445, | Sep 14 2018 | FARO TECHNOLOGIES, INC | Articulated arm coordinate measuring machines with active counterbalance |
10969760, | Apr 12 2018 | FARO TECHNOLOGIES, INC | Coordinate measurement system with auxiliary axis |
11141862, | May 31 2018 | Seiko Epson Corporation | Control apparatus, robot system and control method |
11853028, | Apr 12 2018 | FARO TECHNOLOGIES, INC | Coordinate measurement system with auxiliary axis |
11858133, | Mar 20 2019 | Denso Wave Incorporated | Articulated robot system, and driving method and control apparatus for articulate arm thereof |
11874101, | Apr 12 2018 | FARO TECHNOLOGIES, INC | Modular servo cartridges for precision metrology |
Executed on | Assignor | Assignee | Conveyance | Frame | Reel | Doc |
Dec 28 2016 | Industrial Technology Research Institute | (assignment on the face of the patent) | / | |||
Nov 01 2017 | SU, JUI-YIAO | Industrial Technology Research Institute | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 044713 | /0027 | |
Nov 01 2017 | LIU, YAN-CHEN | Industrial Technology Research Institute | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 044713 | /0027 | |
Nov 01 2017 | CHEN, CHING-SHUN | Industrial Technology Research Institute | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 044713 | /0027 | |
Nov 01 2017 | CHEN, CHANG-YI | Industrial Technology Research Institute | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 044713 | /0027 | |
Nov 01 2017 | WU, CHENG-LI | Industrial Technology Research Institute | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 044713 | /0027 | |
Nov 01 2017 | YU, HUNG-HSIU | Industrial Technology Research Institute | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 044713 | /0027 |
Date | Maintenance Fee Events |
Jun 06 2022 | M1551: Payment of Maintenance Fee, 4th Year, Large Entity. |
Date | Maintenance Schedule |
Dec 04 2021 | 4 years fee payment window open |
Jun 04 2022 | 6 months grace period start (w surcharge) |
Dec 04 2022 | patent expiry (for year 4) |
Dec 04 2024 | 2 years to revive unintentionally abandoned end. (for year 4) |
Dec 04 2025 | 8 years fee payment window open |
Jun 04 2026 | 6 months grace period start (w surcharge) |
Dec 04 2026 | patent expiry (for year 8) |
Dec 04 2028 | 2 years to revive unintentionally abandoned end. (for year 8) |
Dec 04 2029 | 12 years fee payment window open |
Jun 04 2030 | 6 months grace period start (w surcharge) |
Dec 04 2030 | patent expiry (for year 12) |
Dec 04 2032 | 2 years to revive unintentionally abandoned end. (for year 12) |