JP2000006065A - Joint device, robot device, and joint control method - Google Patents

Abstract

PROBLEM TO BE SOLVED: To prevent a hazard at a joint part without mounting an additional sensor in an actuator controller which controls an actuator operating the joint part of a robot arm or the like. SOLUTION: A comparator 471 determines an error between a position command from a controller for a body part and the rotational position of a shaft from a position detecting device 433. An error amplifier 472 amplifies the value of the error to control applied voltage to a motor 431. The rotation of the motor 431 is reduced by a reduction gear 432 to be transmitted to a joint part as the power of bending motion. The position detecting device 433 detects the rotational position of the shaft, of the joint part. A torque limiting value generator 473 inputs the output of the comparator 471 as data D1 and the output of the position detecting device 433 as data D2, generates the limiting value of torque based on these values to give them to the error amplifier 472. The error amplifier 472 amplifies the output of the comparator 471 within a range of the torque limiting value to control the applied voltage to the motor 431. It is thus possible to control the maximum torque to the motor 431.

Description

DETAILED DESCRIPTION OF THE INVENTION

[0001]

The present invention relates to an actuator control device for controlling an actuator for operating a joint such as a robot arm, and more particularly to an actuator control device for controlling a torque.

[0002]

2. Description of the Related Art Conventionally, a machine having a joint such as a robot is provided with an actuator such as a motor and a speed reducer for moving the joint. In an industrial robot, since the torque is strong and the operation is quick, thorough measures have been taken in terms of safety.

[0003] On the other hand, small robots used for demonstrations and the like are designed to have small motor torque and movement so that an unspecified number of people can touch them.

[0004]

However, even when walking or squatting, there is a danger of pinching a person's finger because the angle of the joint is narrowed due to bending of the feet and the like. In this case, although small in size, there is a danger of causing pain or, in the worst case, of injury.
In addition, since the load increases, there is a possibility that the robot-side mechanism may be damaged.

[0005] In order to prevent this, a method is conceivable in which a sensor is provided at the joint portion and the operation is stopped when a large load is applied. However, there are problems in that the number of wirings increases in proportion to the number of sensors, resulting in an increase in cost and an increase in size.

SUMMARY OF THE INVENTION The present invention has been made in view of the above circumstances, and has as its object to provide an actuator control device capable of preventing danger at a joint without providing a special sensor.

[0007]

According to the present invention, in order to solve the above-mentioned problems, an actuator control device for controlling an actuator for operating a joint such as a robot arm detects an operation state of the joint. And a torque limiting unit that limits torque of a driving source of the joint when the joint is performing a bending operation.

In such an actuator control device,
The operation state detecting means detects the operation state of the joint,
When the joint is performing a bending operation, the torque limiting means limits the torque of the drive source of the joint. Therefore, without providing a special sensor, it is possible to prevent a danger caused by pinching of a finger or the like between the joints.

[0009]

Embodiments of the present invention will be described below with reference to the drawings. FIG. 2 is a side view showing the external configuration of the robot of the present embodiment. The robot 1 is, for example, a small robot for demonstration, and is a four-legged walking robot having vertical and horizontal dimensions of several tens of cm and a weight of several kg.
A head 3 is mounted on the body 2 of the robot 1. The head 3 can move up, down, left and right by the neck 31.

Below the torso 2, a left front leg 4, a left rear leg 5,
A right front leg and a right rear leg (not shown) are attached. The left front leg 4 includes a base 41, an upper leg 42, and a lower leg 43. Inside each,
An actuator mechanism including a motor and a gear is provided.

The base 41 is fixed to the body 2 and includes a drive circuit for controlling the operation of the entire left front leg 4. The upper leg part 42 is a joint part 44 part, for example, 120 ° each in the front-rear direction, and further one inward.
It can rotate 5 ° and 90 ° outward. The lower leg 43 is an articulation 45, for example, one in the front-rear direction.
It can be rotated by 20 °.

Similarly, the left rear leg 5 includes a base portion 51, an upper leg portion 52, and a lower leg portion 53. Inside each of them, an actuator mechanism including a motor, a gear, and the like is provided. The base portion 51 is fixed to the body portion 2 and incorporates a drive circuit for controlling the operation of the entire left rear leg 5 and the like. The upper leg portion 52 includes the joint portion 5
4, for example, it is rotatable by 120 ° in the front-rear direction, 15 ° inward, and 90 ° outward. The lower leg 53 is a joint 55 and is rotatable, for example, by 120 ° in the front-rear direction.

The operation of the robot 1 is controlled by a control device built in the body 2. FIG. 3 is a side view showing the structure inside the left front leg 4. FIG. 4 is a front view showing the structure inside the left front leg 4. A motor 411 for driving the upper leg 42 is provided in the case 410 of the base 41. The rotation of the motor 411 is reduced by a speed reducer 412 composed of a plurality of gears, and transmitted to a shaft 441 of the joint 44 (FIG. 4). Thus, the upper leg portion 42 fixed to the tip of the shaft 441 can rotate in the front-rear direction. The angle of the upper leg 42 in the front-rear direction is determined by the position detector 41 attached to the motor 411.
3 is detected.

A motor 421 is provided in the case 420 of the upper leg portion 42. The rotation of the motor 421 is reduced by a speed reducer 422 composed of a plurality of gears and transmitted to a gear 424. The gear 424 is rotatable with respect to the case 420, and its shaft 424 a is fixed to the shaft 441 of the joint 44. Thereby, the upper leg 42
Is rotatable in the open leg and closed leg directions. The current angle is detected by the position detector 423.

In the case 430 of the lower leg 43, a motor 431 is provided. The rotation of the motor 431 is reduced by a speed reducer 432 including a plurality of gears, and transmitted to the gear 451 of the joint 45. The gear 451 is fixed to the case 420 of the upper leg portion 42, and is rotatably attached to the case 430 via a shaft 451a. Thereby, the lower leg 43 is connected to the shaft 451a.
Around the center. Lower leg 43
Is detected by the position detector 433.

A substrate 46 is provided in the case 410 of the base 41. On this substrate 46,
The drive circuit 47 is mounted. The drive circuit 47 receives a position command signal sent from the main control circuit via the connector 48, and controls the drive of each of the motors 411, 421, 431.

The right rear leg 5 and other legs (not shown) have substantially the same configuration as the left front leg 4.
5A and 5B are diagrams showing an operation example of the left front leg 4, wherein FIG. 5A shows a state in which only the lower leg 43 is bent, and FIG. 5B shows an upper leg 42.
It is a figure showing the state where also bent. In the figure (A), the lower leg 4
3 shows a state in which the joint 3 is bent backward by about 90 ° at the joint 45. Further, as shown in FIG. 7B, the upper leg 42 can be bent at the joint 44 while the lower leg 43 is bent.

The same operation as the left front leg 4 can be performed for the right rear leg 5 and other legs not shown. In addition, since the operation of each leg can be individually controlled, the robot 1 can perform a complicated operation.

When the joints 44, 45 and the like are bent in this way, there is a possibility that a human hand is pinched. At this time, if the torque of each of the motors 411, 421, 431 is strong, there is a risk of injury. Therefore, in this embodiment,
According to the angles of the upper leg 42 and the lower leg 43, the motor 41
1,421,431 are controlled.

FIG. 6 is a diagram showing a characteristic example of torque control in the present embodiment. FIG. 7 is a diagram showing a standard of a bending angle. Here, as shown in FIG. 7, the state where the lower leg 43 is not bent is 0 °, the case where the lower leg 43 is bent forward is a minus direction,
When it is bent backward, it is defined as a plus direction. When the bending angle of the lower leg 43 is 0 °, the maximum torque of the motor 431 during operation is set to 100% of the torque capability of the motor 431. Then, as the bending of the lower leg 43 increases in both front and rear directions, that is, as the angle with the upper leg portion 42 decreases, the maximum torque decreases linearly. As a result, the lower the lower leg 43 is bent, the more the torque during operation is limited. Therefore, even if a finger or the like is accidentally pinched, there is no risk of injury.

However, if the direction changes even during the bending operation, the maximum torque of the motor 431 is immediately returned to 100%. For example, it is assumed that the operation has been switched to the operation of extending the joint 45 when the lower leg 43 is bent backward at a bending angle of about 80 ° (point P1). In this case, the maximum torque of the motor 431 is increased from about 50% to 100%.
Return to%. Thereby, a prompt switching operation can be performed.

Also, as shown at point P2, the maximum bending angle 1
When the angle reaches 20 ° (or −120 °), the maximum torque is returned to 100% because no further bending is performed.
Note that the above torque control is not limited to the lower leg 43, and the same control is performed on the upper leg 42 and other legs. Further, the characteristics of the torque control are not limited to those shown in FIG. 6, and the characteristics can be changed between when the lower leg 43 is bent forward and when it is bent backward, as in another example of FIG.

Next, the configuration of the drive circuit 47 for performing such motor torque control will be described. FIG. 1 shows a drive circuit 47 for controlling the torque of the motor of this embodiment.
FIG. 3 is a block diagram showing the configuration of FIG. Here, the lower leg 43
2 shows a configuration of a part related to the above. The comparator 471 is connected to the body 2
Between the position command from the control device described above and the rotational position of the shaft from the position detector 433. The error amplifier 472 amplifies the value of this error, and controls the voltage applied to the motor 431. The rotation of the motor 431 is reduced by the speed reducer 432 and transmitted to the joint 45 as bending power.
The position detector 433 detects the rotational position of the axis of the joint 45.

The torque limit value generator 473 includes a comparator 47
1 is input as data D1 and the output of the position detector 433 is input as data D2, and a torque limit value is generated based on these values. That is, the data such as the rotation direction of the motor 431 and the voltage applied to the motor 431 are known from the data D1. On the other hand, the current bending angle of the joint 45 is known from the data D2. Then, the torque limit value generator 473 generates a torque limit value of the motor 431 based on these data so as to have the torque characteristics shown in FIG.

The error amplifier 472 amplifies the output of the comparator 471 within the range of the torque limit value, and controls the voltage applied to the motor 431. Thus, the maximum torque of the motor 431 is controlled.

FIG. 9 is a block diagram showing the structure of the torque limit value generator 473. In the torque limit value generator 473, two A / D converters 473a and 473 are provided on the input side.
b is provided. A / D converters 473a, 47
3b performs A / D conversion on the data D1 and D2, respectively,
Input as an address signal of OM473c. Thus, an address of the ROM 473c corresponding to the angle of the joint 45, the rotation direction of the motor 431, and the voltage applied to the motor 431 is assigned.

The ROM 473c stores a torque limit value corresponding to each address so that the torque characteristic as shown in FIG. 6 is obtained. The ROM 473c outputs data of the torque limit value corresponding to the input address. The D / A converter 473d D / A converts the data output from the ROM 473c and supplies the data to the error amplifier 472 shown in FIG.

As described above, in the present embodiment, the torque of the motor is limited according to the bending angle of the joint.
Without providing a special sensor, it is possible to prevent the occurrence of injury when a finger or the like is pinched. Further, it is possible to prevent gears and the like from being damaged when a hard object is pinched.

In this embodiment, the torque is limited by controlling the voltage applied to the motor 431.
The torque may be limited using a mechanical device such as a one-way clutch or a torque limiter.

Further, in this embodiment, an example of controlling the torque of the legs of the robot 1 has been described. However, the present invention can be applied to any arm of an industrial robot or any mechanism having a joint other than the robot.

[0031]

As described above, according to the present invention, when the joint portion of the actuator is performing a bending operation, the torque of the drive source of the joint portion is limited, so that a special sensor is not provided. Injury can be prevented even when a finger is pinched between the joints. Further, it is possible to prevent gears and the like from being damaged when a hard object is pinched.

[Brief description of the drawings]

FIG. 1 is a block diagram illustrating a configuration of a drive circuit for performing torque control of a motor according to an embodiment.

FIG. 2 is a side view illustrating an external configuration of the robot according to the embodiment.

FIG. 3 is a side view showing the structure inside the left front leg.

FIG. 4 is a front view showing the structure inside the left front leg.

5A and 5B are diagrams illustrating an operation example of a left front leg, wherein FIG. 5A is a diagram illustrating a state where only a lower leg is bent, and FIG. 5B is a diagram illustrating a state where an upper leg is also bent.

FIG. 6 is a diagram illustrating a characteristic example of torque control in the present embodiment.

FIG. 7 is a diagram showing a standard of a bending angle.

FIG. 8 is a diagram illustrating another characteristic example of torque control.

FIG. 9 is a block diagram showing a configuration of a torque limit value generator.

[Explanation of symbols]

DESCRIPTION OF SYMBOLS 1 ... Robot, 2 ... Torso part, 3 ... Head, 4 ... Left front leg part, 5 ... Left hind leg part, 41, 51 ... Root part, 4
2, 52 ... upper leg, 43, 53 ... lower leg, 44, 4
5 ... joints, 411, 421, 431 ... motor, 4
12, 422, 432 reduction gear, 471 comparator
472: error amplifier; 473: torque limit value generator.

────────────────────────────────────────────────── ───

[Procedure amendment]

[Submission date] June 24, 1999 (1999.6.2
4)

[Procedure amendment 1]

[Document name to be amended] Statement

[Correction target item name] Name of invention

[Correction method] Change

[Correction contents]

Patent application title: JOINT DEVICE, ROBOT DEVICE, AND JOINT CONTROL METHOD

[Procedure amendment 2]

[Document name to be amended] Statement

[Correction target item name] Claims

[Correction method] Change

[Correction contents]

[Claims]

[Procedure amendment 3]

[Document name to be amended] Statement

[Correction target item name] 0006

[Correction method] Change

[Correction contents]

The present invention has been made in view of the above points, and an object of the present invention is to propose a joint device, a robot device, and a joint control method capable of significantly improving safety.

[Procedure amendment 4]

[Document name to be amended] Statement

[Correction target item name] 0007

[Correction method] Change

[Correction contents]

[0007]

In order to solve the above-mentioned problems, according to the present invention, provided between a first member and a second member, a rotating shaft of the first member and the second member is provided. A joint mechanism rotatably supported as a center, an actuator for driving the joint mechanism, actuator control means for controlling the actuator, and a joint state for detecting a state of a joint formed by the first member and the second member Detecting means,
The actuator control means controls the actuator based on the detection result of the joint state detection means.
As a result, in this joint device, by controlling the actuator that drives the joint mechanism based on the state of the joint formed by the first member and the second member, even when a finger is pinched by the joint, Injury can be prevented. Further, in the present invention, in the robot device having the joint device, the joint device is provided between the first member and the second member, and is provided around a rotation axis of the first member and the second member. A joint mechanism rotatably supported, an actuator for driving the joint mechanism, an actuator control means for controlling the actuator, and a joint state detecting means for detecting a state of a joint formed by the first member and the second member And the actuator control means controls the actuator based on the detection result of the joint state detection means. As a result, in the joint device of this robot device, the finger is pinched between the joints by controlling the actuator that drives the joint mechanism based on the state of the joint formed by the first member and the second member. In some cases, the occurrence of injuries can be prevented.

[Procedure amendment 5]

[Document name to be amended] Statement

[Correction target item name] 0008

[Correction method] Change

[Correction contents]

Further, according to the present invention, there is provided a joint mechanism provided between the first member and the second member for rotatably supporting the first member and the second member about a rotation axis. After detecting the state of the joint formed by the first member and the second member, the actuator that drives the joint mechanism is controlled based on the detection result of the state of the joint. As a result, in this joint control method, by controlling the actuator that drives the joint mechanism based on the state of the joint formed by the first member and the second member, even when a finger is pinched by the joint, Injury can be prevented.

[Procedure amendment 6]

[Document name to be amended] Statement

[Correction target item name] 0031

[Correction method] Change

[Correction contents]

[0031]

As described above, according to the present invention, the first member and the second member are provided between the first member and the second member, and are rotatable about the rotation axis of the first member and the second member. A joint mechanism for supporting, an actuator for driving the joint mechanism, an actuator control means for controlling the actuator,
By providing joint state detecting means for detecting a state of a joint formed by the member and the second member, the actuator control means controls the actuator based on the detection result of the joint state detecting means, Even when a finger is pinched between the joint formed by the first member and the second member, the occurrence of injury can be prevented, and thus a joint device that can significantly improve safety can be realized. Further, according to the present invention, in the robot device having the joint device, the joint device is provided between the first member and the second member, and the first member and the second member are connected to each other.
A joint mechanism that rotatably supports the member about the rotation axis, an actuator that drives the joint mechanism, actuator control means that controls the actuator, and a joint formed by the first member and the second member Joint state detecting means for detecting the state of the actuator, the actuator control means,
The first member and the second member are controlled by controlling the actuator based on the detection result of the joint state detecting means.
It is possible to prevent the occurrence of injuries even when a finger is pinched between the joints formed by the members described above, and thus to realize a robot device that can significantly improve safety. I did it. Further, in the present invention, the first joint mechanism is provided between the first member and the second member and supports the first member and the second member rotatably about a rotation axis. After detecting the state of the joint formed by the member and the second member, the first member and the second member are controlled by controlling the actuator that drives the joint mechanism based on the detection result of the state of the joint. Even when a finger is pinched between the joints formed by the two members, the occurrence of injury can be prevented, and thus a joint control method that can significantly improve safety can be realized.

Claims (5)

[Claims] 1. An actuator control device for controlling an actuator for operating a joint such as a robot arm, comprising: an operating state detecting means for detecting an operating state of the joint; An actuator control device, comprising: torque limiting means for limiting torque of a drive source of the joint. 2. The actuator control device according to claim 1, wherein the torque limiting unit changes the torque limit value according to a bending angle of the joint. 3. The actuator control device according to claim 2, wherein the torque limiting unit releases the torque limitation when a bending direction of the joint changes. 4. The actuator control according to claim 1, wherein the driving source is a motor, and the torque limiting unit controls the torque by controlling an applied voltage or an applied current of the motor. apparatus. 5. An apparatus according to claim 1, further comprising an adjusting mechanism capable of adjusting a transmission force of the driving source, wherein the torque limiting unit controls the torque by controlling the adjusting mechanism. The actuator control device according to claim 1.