# US 2018/0043525 A1 · Control device of robot arm and teaching system and method using the same

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2018/0043525 A1
- Document ID: US20180043525A1
- Status: Published application
- Kind: A1
- Application number: 15/392,251
- Filed: 2016-12-28
- Published: 2018-02-15
- Earliest claimed: 2016-08-12
- Assignees: Industrial Technology Research Institute
- Applicants: Industrial Technology Research Institute
- Inventors: Jui-Yiao Su; Yan-Chen Liu; Ching-Shun Chen; Chang-Yi Chen; Cheng-Li Wu; Hung-Hsiu Yu
- Web page: https://patentgrep.com/patent/US20180043525A1

## CPC

- B25J 9/0081: {with leader teach-in means}
- B25J 13/081: {Touching devices, e.g. pressure-sensitive}
- G05B 19/423: Teaching successive positions by walk-through, i.e. the tool head or end effector being grasped and guided directly, with or without servo-assistance, to follow a path
- G05B 19/425: Teaching successive positions by numerical control, i.e. commands being entered to control the positioning servo of the tool head or end effector
- G05B 2219/36417: Programmed coarse position, fine position by alignment, follow line, path adaptive
- G05B 2219/36433: Position assisted teaching
- G05B 2219/39548: Enter interactively parameter for gripper, then teach movement
- B25J: MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES ({manipulators specially adapted for use in surgery A61B34/70; manipulators used in cleaning hollow articles B08B9/04}; manipulators associated with rolling mills B21B39/20; manipulators associated with forging machines B21J13/10; {manipulators associated with picking-up and placing mechanisms B23P19/007}; means for holding wheels or parts thereof B60B30/00; {vehicles with ground-engaging propulsion means, e.g. walking members B62D57/02, B62D57/032; devices for picking-up and depositing articles or materials between conveyors B65G47/90, B65G47/91; manipulators with gripping or holding means for transferring packages B65H67/065}; cranes B66C; {manipulators used in the protection or supervision of pipe-line installations F17D5/00; walking equipment adapted for nuclear steam-generators F22B37/006}; manipulators specially adapted for, or associated with, nuclear reactors G21C; {apparatus used for handling wafers during manufacture or treatment of semiconductor H10P72/50})
- G05B: CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS (systems for controlling or regulating non-electric variables G05D; systems for regulating electric or magnetic variables G05F; control devices or systems insofar as characterised by mechanical features only G05G)

## Abstract

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.

## Claims

### Claim 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.

### Claim 2 (depends on 1)

The control device according to claim 1, wherein the pressure sensing module comprises a plurality of pressure sensing elements interconnected and arranged in a form of an array, each pressure sensing element has an upper electrode layer, a pressure sensing layer and a lower electrode layer, and the pressure sensing layer is interposed between the upper electrode layer and the lower electrode layer.

### Claim 3 (depends on 1)

The control device according to claim 1, wherein the touch-sensing surface is a curved surface, and located on the end effector of the robot arm.

### Claim 4 (depends on 3)

The control device according to claim 3, wherein the end effector is a cylinder with an axis, the first touch-sensing region and the second touch-sensing region both surround the circumferential surface of the cylinder.

### Claim 5 (depends on 4)

The control device according to claim 4, wherein the robot arm performs one-dimensional (1D) or two-dimensional (2D) translational motion perpendicular to the axis of the end effector according to a single-touch point on the first touch-sensing region, or performs a translational motion along the axis of the end effector according to trajectories formed by at least two touch points on the first touch-sensing region.

### Claim 6 (depends on 4)

The control device according to claim 4, wherein the robot arm performs a rotational motion rotating about the axis perpendicular to the axis of the end effector according to a single-touch point on the second touch-sensing region, or performs a rotational motion rotating about the axis of the end effector according to trajectories formed by at least two touch points on the second touch-sensing region.

### Claim 7 (depends on 1)

The control device according to claim 1, wherein the control module comprises a joint-motor controller and a mode-switching module, the mode-switching module is for switching operating modes of the robot arm, the operating modes of the robot arm comprise a compliance teaching mode and a touch operating mode, under the touch operating mode, the joint-motor controller generates a set of motor torque signals for moving the robot arm according to the operation command.

### Claim 8 (depends on 7)

The control device according to claim 7, wherein the control module comprises at least a joint-motor encoder disposed on a joint of the robot arm, and the joint-motor encoder generates a set of joint angle and torque signals according to the moving trajectory of the robot arm under the compliance teaching mode.

### Claim 9 (depends on 8)

The control device according to claim 8, wherein the control module comprises a teaching controller, and the teaching controller stores the set of joint angle and torque signals generated by the joint-motor encoder under the compliance teaching mode and converts those signals into the motor driving signal to reproduce the moving trajectory of the robot arm.

### Claim 10 (depends on 7)

The control device according to claim 7, wherein the joint-motor controller further comprises a gravity compensator, the gravity compensator calculates a gravity compensation torque applied to each link according to an angle of each joint, the mass and length of each link, and the distances between the mass-center of each link and joint.

### Claim 11 (depends on 7)

The control device according to claim 7, wherein the joint-motor controller further comprises a friction compensator, the friction compensator calculates a friction compensation torque applied to each joint according to a rotation speed of each joint of the robot arm.

### Claim 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.

### Claim 13 (depends on 12)

The teaching system according to claim 12, wherein the pressure sensing module comprises a plurality of pressure sensing elements interconnected and arranged in a form of an array, each pressure sensing element has an upper electrode layer, a pressure sensing layer and a lower electrode layer, and the pressure sensing layer is interposed between the upper electrode layer and the lower electrode layer.

### Claim 14 (depends on 12)

The teaching system according to claim 12, wherein the touch-sensing surface is a curved surface, and located on the end effector of the robot arm.

### Claim 15 (depends on 14)

The teaching system according to claim 14, wherein the end effector is a cylinder with an axis, and the first touch-sensing region and the second touch-sensing region both surround a circumferential surface of the cylinder.

### Claim 16 (depends on 15)

The teaching system according to claim 15, wherein the robot arm performs 1D or 2D translational motion perpendicular to the axis of the end effector according to a single-touch point on the first touch-sensing region, or performs a translational motion along the axis of the end effector according to trajectories formed by at least two touch points on the first touch-sensing region.

### Claim 17 (depends on 15)

The teaching system according to claim 15, wherein the robot arm performs a rotational motion rotating about the axis perpendicular to the axis of the end effector according to a single-touch point on the second touch-sensing region, or performs a rotational motion rotating about the axis of the end effector according to trajectories formed by at least two touch points on the second touch-sensing region.

### Claim 18 (depends on 14)

The teaching system according to claim 14, wherein the control module further comprises a teaching controller, the teaching controller stores a set of joint angle and torque signals generated by the joint-motor encoders under the compliance teaching mode and converts the set of joint angle and torque signals into the motor driving signal to reproduce the moving trajectory of the robot arm.

### Claim 19 (depends on 14)

The teaching system according to claim 14, wherein the joint-motor controller further comprises a gravity compensator, the gravity compensator calculates a gravity compensation torque applied to each link of the robot arm according to an angle of each joint, the mass and length of each link, and the distances between the mass-center of each link and joint.

### Claim 20 (depends on 14)

The teaching system according to claim 14, wherein the joint-motor controller further comprises a friction compensator, the friction compensator calculates a friction compensation torque applied to each joint according to a rotation speed of each joint of the robot arm.

### Claim 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.
