Patent Application
20190389052
The present application is based on, and claims priority from, JP Application Serial Number 2018-119541, filed Jun. 25, 2018, the disclosure of which is hereby incorporated by reference herein in its entirety.
The present disclosure relates to a control apparatus of a robot, robot, and robot system.
As a mode for facilitating teaching work by a robot, a direct teaching mode in which a teacher directly holds fingers of a robot and operating the finger position of the robot is known. In the direct teaching mode, the robot can be continuously and largely moved, however, fine positioning is difficult only by the continuous movement. In JP-A-2017-164876 disclosed by the applicant of the present application, a technique of fine positioning using a mode in which the robot is moved according to an external force in a predetermined direction in a predetermined amount is described.
JP-A-2017-164876 is an example of the related art.
However, in the above described related art, a form and a method of input for a mode in which the robot is moved in a small predetermined amount is not sufficiently considered.
According to an aspect of the present disclosure, a control apparatus that controls a robot including a movable unit and an input detection unit provided in the movable unit is provided. The control apparatus includes a control unit that controls the movable unit in a specific control mode in which the movable unit is moved in an amount of movement input by a user according to input detected by the input detection unit in teaching of the robot. The input detection unit includes at least one of an electromagnetic sensor, a thermal sensor, a capacitance sensor, a magnetic sensor, an angular velocity sensor, an acceleration sensor, an ultrasonic sensor, and a current sensor.
The robot 100 has a base 110 and an arm 120. A force detection unit 190 is provided in the distal end of the arm 120, and an end effector 130 is attached to the distal end side of the force detection unit 190. As the end effector 130, any type of end effector may be used. In the example of
An input detection unit 600 that detects other input than force is provided in the end effector 130. The input detection unit 600 is used for detection of input for execution of control in a specific control mode in which the movable unit is moved in a predetermined amount of movement. It is preferable that the input detection unit 600 includes one or more sensors. The input detection unit 600 will be further described later.
The control apparatus 200 has a processor 210, a main memory 220, a nonvolatile memory 230, a display control unit 240, a display unit 250, and an I/O interface 260. These respective parts are connected via a bus. The processor 210 is e.g. a microprocessor or processor circuit. The control apparatus 200 is connected to the robot 100 and the teaching apparatus 300 via the I/O interface 260. Note that the control apparatus 200 may be housed inside of the robot 100.
As the configuration of the control apparatus 200, various other configurations than the configuration shown in
The teaching apparatus 300 is used for creation of control programs (teaching data) for work of the robot 100. The teaching apparatus 300 is also called “teaching pendant”. In place of the teaching pendant, a personal computer with an application program for teaching processing installed therein can be used.
The force detection unit 190 is a six-axis force sensor that measures external forces applied to the end effector 130. The force detection unit 190 has three detection axes X, Y, Z orthogonal to one another in a sensor coordinate system Σf as an intrinsic coordinate system, and detects magnitude of forces parallel to the respective detection axes and magnitude of torque (moment of forces) about the respective detection axes. The force parallel to the each detection axis is referred to as “translational force”. Further, the torque about each detection axis is referred to as “rotational force”. In this specification, the word “force” is used in a meaning including both the translational force and the rotational force.
The force detection unit 190 is not necessarily a sensor that detects forces along the six axes, but a sensor that detects forces in the smaller number of directions may be used. Or, the force detection unit 190 is not provided in the distal end of the arm 120, but a force sensor as a force detection unit may be provided in one or more joints of the arm 120. Note that the force detection unit may be omitted. In this case, control in a first control mode, which will be described later, is not executed.
In the teaching processing, a plurality of control modes including the first control mode and the second control mode described as below are available.
The first control mode is a mode in which the arm 120 is continuously moved according to the force detected by the force detection unit 190. The first control mode is a mode, the so-called direct teaching, and, when the user applies a force while holding the end effector 130, the arm 120 smoothly moves according to the force. In this regard, the control apparatus 200 executes compliance control as a kind of force control to move the arm 120. The compliance control in the direct teaching is control to move the arm 120 based on predetermined force control parameters (mass M, viscosity coefficient D, elasticity coefficient K in the equation of motion). The movement in the first control mode is also referred to as “continuous movement”.
The second control mode is a mode in which the arm 120 is moved in a predetermined amount of movement according to the input detected by the input detection unit 600. The amount of movement is set by the user's input. The second control mode corresponds to “specific control mode”. The amount of movement in the second control mode is set to e.g. a small amount of translation (amount of translational movement) from 0.1 mm to 1 mm for translational movement and set to e.g. a small rotation angle (amount of rotational movement) from 0.1 degrees to 3 degrees for rotation. In this manner, fine adjustment of the positions of the end effector 130 and the TCP can be made. The movement in the second control mode is also referred to as “fixed-amount movement”.
Note that, for moving the movable unit in a Z-axis direction, an input detection unit for Z-axis direction may be provided. Or, an input detection unit for rotating the movable unit around the X-axis, Y-axis, or Z-axis in a small amount of rotation may be provided. Also, in this case, it is preferable to provide input detection units exclusive for the respective axes as input detection units for rotation.
As the input detection unit 600, for example, the following various sensors can be used.
(1) Non-contact Sensor
(2) Pressure Sensor
(3) Inertial Sensor
(4) Rotary Dial
As the non-contact sensor, a proximity sensor that detects input to the non-contact sensor when an object such as the hand HA comes close at a distance equal to or smaller than a predetermined distance threshold value from the non-contact sensor can be used. The distance threshold value can be set to e.g. from 10 mm to 100 mm. As the proximity sensor, e.g. an optical proximity sensor using a photo reflector, a capacitance proximity sensor, or the like can be used. Further, the non-contact sensor may be realized using an electromagnetic sensor such as a photosensor, a thermal sensor, a magnetic sensor, an ultrasonic sensor, or the like. When the non-contact sensor is used as the input detection unit 600, a plurality of non-contact sensors are preferably provided for a plurality of movement directions of the movable unit. Accordingly, the movable unit can be moved in a desired movement direction of the plurality of movement directions.
In
As the input detection unit 600, an inertial sensor can be used. The inertial sensor may be realized using an angular velocity sensor, acceleration sensor, or the like. The inertial sensor is also called IMU (Inertial Measurement Unit), and detects angles or angular velocities and accelerations in directions of a plurality of axes. Note that the inertial sensor itself is a sensor that detects motion and, when the inertial sensor is used as the input detection unit 600, a specification switch for switching the control mode to the specific control mode may be provided in the movable unit. The control mode is switched to the specific control mode by the specification switch, then, a force is applied to the end effector 130, and thereby, input is detected by the inertial sensor and movement of the movable unit in the specific control mode is executed. Further, the movement direction of the movable unit is determined according to the directions of the angular velocities and accelerations detected by the inertial sensor.
As the input detection unit 600, further, a magnetic sensor can be used. The input to the magnetic sensor may be made by e.g. contacting the magnetic sensor with a hand wearing a glove with magnet. The input detection unit 600 using the magnetic sensor can be provided at the surface of the end effector 130 as shown in
As the input detection unit, further, a current sensor can be used. For example, a current sensor that detects the current value of the actuator 170 of the arm 120 may be used as the input detection unit. In this case, a specification switch for switching the control mode to the specific control mode may be provided in the movable unit. Note that all of the above described other types of input detection units may be provided at the surface of the movable unit, however, it is hard to provide the current sensor at the surface of the movable unit. In view of the ease of input, it is preferable to provide the input detection unit at the surface of the movable unit.
As described above, as the input detection unit that detects input for the specific control mode, various configurations that detect other input than force can be used. Particularly, the input detection unit is provided at the surface of the movable unit, and thereby, the user can easily make input for the specific control mode. The input detection unit can be adapted to include one or more sensors, and may be formed to include a plurality of sensors.
On the other hand, at time t3, the second input is detected by the input detection unit 600, and the movable unit moves in the small amount of movement ΔL according to the detection of the second input.
At step S111, the apparatus waits until input is detected by the force detection unit 190 or the input detection unit 600. If the input is detected at step S111, the control mode selection unit 214 selects a control mode according to whether the detected input is the first input or the second input. That is, when a force as the first input is detected by the force detection unit 190, the first control mode is selected and the processing moves to step S112. The control in the first control mode by the movable unit control unit 212 is continued until ending of the first control mode is determined at the next step S113, and then, the processing moves to step S115. On the other hand, when the second input is detected by the input detection unit 600 at step S111, the second control mode is selected and the processing moves to step S114, the movable unit control unit 212 executes the fixed-amount movement in the second control mode, and then, the processing moves to step S115. At step S115, the control apparatus 200 determines whether or not a taught point is set by the teaching apparatus 300. When no taught point is set, the processing returns to step S111, and the above described steps S111 to S115 are repeated until the movable unit reaches appropriate position and posture. On the other hand, when the movable unit reaches the appropriate position and posture, the taught point is set at step S115. That is, the position of the movable unit is employed as a taught position according to the input from the teaching apparatus 300. When the taught point is set at step S115, the processing moves to step S116, and whether or not the teaching processing ends is determined. When the teaching processing does not end, the processing returns to step S111. Note that, for example, an instruction to end the teaching processing may be given by the user using the teaching apparatus 300.
As described above, in the first embodiment, the control of the movable unit is executed in the specific control mode in which the movable unit is moved in a predetermined amount of movement according to the input detected by the input detection unit 600. Further, as the input detection unit 600, a sensor that detects other input than force or the like is used. Therefore, movement of the movable unit in the specific control mode can be executed using the input detection unit 600 that detects other input than force.
The present disclosure is not limited to the above described embodiment, but may be realized in various aspects without departing from the scope thereof. For example, the present disclosure can be realized in the following aspects. The technical features in the above described embodiment corresponding to technical features in the following respective aspects can be appropriately replaced or combined for solving part or all of the problems of the present disclosure or achieving part or all of the effects of the present disclosure. Further, the technical features can be appropriately deleted unless the technical features are described as essential features in this specification.
(1) According to a first aspect of the present disclosure, a control apparatus that controls a robot including a movable unit and an input detection unit provided in the movable unit is provided. The control apparatus includes a control unit that controls the movable unit in a specific control mode in which the movable unit is moved in an amount of movement input by a user according to input detected by the input detection unit in teaching of the robot. The input detection unit includes at least one of an electromagnetic sensor, a thermal sensor, a capacitance sensor, a magnetic sensor, an angular velocity sensor, an acceleration sensor, an ultrasonic sensor, and a current sensor.
According to the control apparatus, the movement of the movable unit in the specific control mode can be executed using the input detection unit including the sensor that detects other input than force.
(2) The control apparatus may include an input receiving unit that receives input of the amount of movement from the user.
In the configuration, the form of movement in the specific control mode can be set according to the preference of the user.
(3) In the control apparatus, the input detection unit may include at least one non-contact sensor of the electromagnetic sensor, the thermal sensor, the magnetic sensor, and the ultrasonic sensor.
(4) In the control apparatus, the input detection unit may include a plurality of the non-contact sensors provided in a plurality of positions corresponding to a plurality of movement directions of the movable unit.
In the configuration, the movement direction of the movable unit in the specific control mode may be designated using the plurality of non-contact sensors.
(5) In the control apparatus, the non-contact sensor may detect input to the non-contact sensor when an object comes close at a predetermined distance or less from 10 mm to 100 mm from the non-contact sensor.
In the configuration, the movement in the specific control mode may be executed only by moving a hand or the like close to the non-contact sensor.
(6) According to a second aspect of the present disclosure, a robot controlled by a control unit is provided. The robot includes a movable unit and an input detection unit provided in the movable unit, and the movable unit is controlled by the control unit in a specific control mode in which the movable unit is moved in an amount of movement input by a user according to input detected by the input detection unit in teaching of the robot. The input detection unit includes at least one of an electromagnetic sensor, a thermal sensor, a capacitance sensor, a magnetic sensor, an angular velocity sensor, an acceleration sensor, an ultrasonic sensor, and a current sensor.
According to the robot, the movement of the movable unit in the specific control mode can be executed using the input detection unit including the sensor that detects other input than force.
(7) According to a third aspect of the present disclosure, a robot system including a robot including a movable unit and an input detection unit provided in the movable unit, and one of the above described control apparatuses is provided.
According to the robot system, the movement of the movable unit in the specific control mode can be executed using the input detection unit including the sensor that detects other input than force.
The present disclosure can be realized in various other aspects than the above described aspects, e.g. a robot system including a robot and a robot control apparatus, a computer program for realizing functions of a robot control apparatus, a non-transitory storage medium with the computer program recorded therein, or the like.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2018-119541 | Jun 2018 | JP | national |
