US20200406451A1 - Robot - Google Patents
Robot Download PDFInfo
- Publication number
- US20200406451A1 US20200406451A1 US16/912,744 US202016912744A US2020406451A1 US 20200406451 A1 US20200406451 A1 US 20200406451A1 US 202016912744 A US202016912744 A US 202016912744A US 2020406451 A1 US2020406451 A1 US 2020406451A1
- Authority
- US
- United States
- Prior art keywords
- axis
- arm
- robot
- center line
- base
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/085—Force or torque sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J18/00—Arms
- B25J18/02—Arms extensible
-
- 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/0009—Constructional details, e.g. manipulator supports, bases
-
- 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
-
- 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/041—Cylindrical coordinate type
- B25J9/042—Cylindrical coordinate type comprising an articulated arm
- B25J9/044—Cylindrical coordinate type comprising an articulated arm with forearm providing vertical linear movement
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
-
- 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/12—Programme-controlled manipulators characterised by positioning means for manipulator elements electric
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40582—Force sensor in robot fixture, base
Definitions
- the present disclosure relates to a robot.
- the various robots include e.g. bases, arms supported by the bases, and force sensors as shown in JP-A-2018-080941.
- the arms are controlled based on detection results of the force sensors.
- the force sensor is provided below the base. Accordingly, load of the base and the arm is applied onto the force sensor.
- the force is transmitted to the force sensor via the arm and the base. The force may be detected and the arm may be controlled based on the detection result.
- the present disclosure can be implemented as follows.
- a robot includes a base, a robot arm having a first arm coupled to the base and rotating about a first axis, and a force detection unit provided in the base and detecting a force acting on the base or the robot arm, wherein the first arm is coupled to the base in a position shifted from a first center line passing through a center of the base and being parallel to the first axis, and a second center line passing through a center of the force detection unit and being parallel to the first axis is closer to the first axis than the first center line.
- FIG. 1 is a side view showing a first embodiment of a robot system including a robot according to the present disclosure.
- FIG. 2 is a block diagram of the robot system shown in FIG. 1 .
- FIG. 3 is a side view of a force detection unit shown in FIG. 1 .
- FIG. 4 is a sectional view along line A-A in FIG. 3 .
- FIG. 5 is a schematic diagram of the robot shown in FIG. 1 .
- FIG. 6 is a schematic diagram of a second embodiment of the robot according to the present disclosure.
- FIG. 7 is a schematic diagram of a third embodiment of the robot according to the present disclosure.
- FIG. 1 is the side view showing the first embodiment of the robot system including the robot according to the present disclosure.
- FIG. 2 is the block diagram of the robot system shown in FIG. 1 .
- FIG. 3 is the side view of the force detection unit shown in FIG. 1 .
- FIG. 4 is the sectional view along line A-A in FIG. 3 .
- FIG. 5 is the schematic diagram of the robot shown in FIG. 1 .
- an x-axis, a y-axis, and a z-axis are shown as three axes orthogonal to one another.
- directions parallel to the x-axis are also referred to as “x-axis directions”
- directions parallel to the y-axis are also referred to as “y-axis directions”
- directions parallel to the z-axis are also referred to as “z-axis directions”.
- a direction parallel to the +x-axis direction is also referred to as “+x-axis direction”
- a direction parallel to the ⁇ x-axis direction is also referred to as “ ⁇ x-axis direction”
- a direction parallel to the +y-axis direction is also referred to as “+y-axis direction”
- a direction parallel to the ⁇ y-axis direction is also referred to as “ ⁇ y-axis direction”
- a direction parallel to the +z-axis direction is also referred to as “+z-axis direction”
- a direction parallel to the ⁇ z-axis direction is also referred to as “ ⁇ z-axis direction”.
- a direction about the z-axis and a direction about an axis parallel to the z-axis are also referred to as “u-axis directions”.
- the +z-axis direction in FIG. 1 i.e., the upside is also referred to as “upper” or “above” and the ⁇ z-axis direction, i.e., the downside is also referred to as “lower” or “below”.
- a side of a base 21 in FIG. 1 is referred to as “proximal end” and the opposite side, i.e., a side of an end effector 7 is referred to as “distal end”.
- the z-axis directions in FIG. 1 i.e., upward and downward directions are referred to as “vertical directions” and the x-axis directions and the y-axis directions, i.e., leftward and rightward directions are referred to as “horizontal directions”.
- a robot system 100 shown in FIGS. 1 and 2 is an apparatus used for work of e.g. holding, transport, assembly, inspection, etc. of works including electronic components and electronic apparatuses.
- the robot system 100 includes a control apparatus 1 , a robot 2 , and the end effector 7 . Additionally, the robot system 100 includes a display device 41 , an input device 42 , etc.
- the control apparatus 1 is placed in a position different from that of the robot 2 , i.e., outside of the robot 2 . Further, in the illustrated configuration, the robot 2 and the control apparatus 1 are electrically coupled (hereinafter, also simply referred to as “coupled”) by a cable 200 , however, not limited thereto the cable 200 may be omitted for wireless communication. That is, the robot 2 and the control apparatus 1 may be connected in wired communication or connected in wireless communication. Further, the control apparatus 1 may be provided inside of the base 21 of the robot 2 .
- the robot 2 is a horizontal articulated robot, i.e., a scalar robot.
- the robot 2 includes the base 21 , a first arm 22 , a second arm 23 , a third arm 24 as a working head, and a force detection unit 5 .
- the first arm 22 , the second arm 23 , and the third arm 24 form the robot arm 20 .
- the robot 2 includes a drive unit 25 that rotates the first arm 22 relative to the base 21 , a drive unit 26 that rotates the second arm 23 relative to the first arm 22 , a u-drive unit 27 that rotates a shaft 241 of the third arm 24 relative to the second arm 23 , a z-drive unit that moves the shaft 241 in the z-axis directions relative to the second arm 23 , and an angular velocity sensor 29 .
- the robot 2 includes the base 21 rotatably supporting the robot arm 20 , and the robot arm 20 includes the first arm 22 and the second arm 23 located at the distal side of the first arm 22 with respect to the base 21 . Thereby, the movable range of the robot arm 20 may be increased.
- the drive unit 25 is provided within a housing 220 of the first arm 22 , and has a motor 251 that generates a driving force, a reducer 252 that reduces the driving force of the motor 251 , and a position sensor 253 that detects the rotation angle of the rotation shaft of the motor 251 or the reducer 252 .
- the drive unit 26 is provided within a housing 230 of the second arm 23 , and has a motor 261 that generates a driving force, a reducer 262 that reduces the driving force of the motor 261 , and a position sensor 263 that detects the rotation angle of the rotation shaft of the motor 261 or the reducer 262 .
- the u-drive unit 27 is provided within the housing 230 of the second arm 23 , and has a motor 271 that generates a driving force, a reducer 272 that reduces the driving force of the motor 271 , and a position sensor 273 that detects the rotation angle of the rotation shaft of the motor 271 or the reducer 272 .
- the z-drive unit 28 is provided within the housing 230 of the second arm 23 , and has a motor 281 that generates a driving force, a reducer 282 that reduces the driving force of the motor 281 , and a position sensor 283 that detects the rotation angle of the rotation shaft of the motor 281 or the reducer 282 .
- the motor 251 the motor 261 , the motor 271 , and the motor 281 , e.g. servo motors such as AC servo motors or DC servo motors may be used.
- servo motors such as AC servo motors or DC servo motors
- the reducer 252 the reducer 262 , the reducer 272 , and the reducer 282 , e.g. planet-gear reducers, wave gearings, or the like may be used.
- the position sensor 253 the position sensor 263 , the position sensor 273 , and the position sensor 283 , e.g. angle sensors may be used.
- the drive unit 25 , the drive unit 26 , the u-drive unit 27 , and the z-drive unit 28 are respectively coupled to corresponding motor drivers (not shown) and controlled by a robot control unit 11 of the control apparatus 1 via the motor drivers.
- the angular velocity sensor 29 is provided inside of the second arm 23 . Accordingly, the angular velocity of the second arm 23 may be detected.
- the control apparatus 1 performs control of the robot 2 based on information of the detected angular velocity.
- the base 21 is fixed to e.g. a floor surface (not shown) by bolts or the like.
- the first arm 22 is coupled to the upper end portion of the base 21 .
- the first arm 22 is rotatable about a first axis O 1 along the vertical directions relative to the base 21 .
- the drive unit 25 that rotates the first arm 22 is driven, the first arm 22 rotates about the first axis O 1 within the horizontal plane relative to the base 21 .
- the position sensor 253 may detect the amount of rotation of the first arm 22 relative to the base 21 .
- the second arm 23 is coupled to the distal end portion of the first arm 22 .
- the second arm 23 is rotatable about a second axis O 2 along the vertical directions relative to the first arm 22 .
- the axial direction of the first axis O 1 and the axial direction of the second axis O 2 are the same. That is, the second axis O 2 is parallel to the first axis O 1 .
- the position sensor 263 may detect the amount of drive, specifically, the amount of rotation of the second arm 23 relative to the first arm 22 .
- the third arm 24 is placed and supported in the distal end portion of the second arm 23 .
- the third arm 24 has the shaft 241 .
- the shaft 241 is rotatable about a third axis O 3 along the vertical directions relative to the second arm 23 and movable in the upward and downward directions.
- the shaft 241 is an arm at the most distal end of the robot arm 20 .
- the position sensor 273 may detect the amount of rotation of the shaft 241 relative to the second arm 23 .
- the position sensor 283 may detect the amount of movement of the shaft 241 in the z-axis directions relative to the second arm 23 .
- the robot arm 20 has the first arm 22 , the second arm 23 coupled to the first arm 22 at an opposite side to the base 21 and rotating about the second axis O 2 parallel to the first axis O 1 , and the third arm 24 supported by the second arm 23 and moving along an axial direction of the third axis O 3 in a position different from that of the second axis O 2 in parallel to the second axis O 2 .
- the movable range on the xy-plane may be sufficiently secured by the first arm 22 and the second arm 23 , and actuation in the z-axis directions may be performed by the third arm 24 .
- end effectors are detachably coupled to the distal end portion of the shaft 241 .
- the end effectors are not particularly limited to, but include e.g. an end effector that grips an object to be transported, an end effector that processes a workpiece, an end effector used for an inspection, etc.
- the end effector is detachably coupled.
- the end effector 7 will be described later in detail.
- end effector 7 is not a component element of the robot 2 in the embodiment, however, a part or all of the end effector 7 may be a component element of the robot 2 . Further, the end effector 7 is not a component element of the robot arm 20 in the embodiment, however, a part or all of the end effector 7 may be a component element of the robot arm 20 .
- the end effector 7 has an attachment portion 71 attached to the shaft 241 , a motor 72 provided in the attachment portion 71 , and a screw limit gauge 3 detachably and coaxially attached to the rotation shaft of the motor 72 .
- the end effector 7 is detachably coupled to the distal end portion of the shaft 241 .
- the motor 72 is not particularly limited, but e.g. a servo motor such as an AC servo motor or DC servo motor, stepping motor, or the like is used.
- the end effector 7 has an angle sensor (not shown) that detects the rotation angle of the rotation shaft of the motor 72 , and the angle sensor may detect the rotation angle of the rotation shaft of the motor 72 .
- the end effector 7 is detachable from the robot arm 20 , however, not limited thereto, for example, the end effector 7 may be undetachable from the robot arm 20 .
- the force detection unit 5 detects a force applied to the robot 2 , i.e., a force applied to the robot arm 20 and the base 21 .
- the force detection unit 5 is provided under the base 21 , i.e., at the ⁇ z-axis side and supports the base 21 from underneath. Accordingly, a load of the weights of the robot arm 20 and the base 21 is applied onto the force detection unit 5 .
- the force detection unit 5 is a member in a cylindrical outer shape having a first plate 51 , a second plate 52 , a tubular portion 53 placed between the first plate 51 and the second plate 52 , and a plurality of, in the embodiment, four elements 54 .
- the four elements 54 are sandwiched between the first plate 51 and the second plate 52 .
- the number of the elements 54 is not limited to that, but may be three or less or five or more.
- the first plate 51 and the second plate 52 have circular disc shapes and are sequentially placed from the +z-axis side. Note that the shapes of the first plate 51 and the second plate 52 in a plan view are not limited to the circular shapes, but may be any shapes.
- the tubular portion 53 has a cylindrical shape in the embodiment and has a function of protecting the elements 54 .
- the respective elements 54 are placed at equal intervals to form a circular shape. Thereby, forces applied to the respective elements 54 may be as uniform as possible and the forces may be accurately detected.
- a line passing through the center of a circle C on which the respective elements 54 are placed and being parallel to the z-axis, i.e., the first axis O 1 is referred to as “center line S 5 ”.
- the center of the force detection unit 5 is the center of the circle C on which the respective elements 54 are placed.
- the geometric center of a figure with the respective elements 54 as vertices is referred to as the center of the force detection unit 5 .
- elements formed using e.g. piezoelectric materials such as quartz crystal and outputting electric charge by application of external force may be employed.
- the control apparatus 1 may convert the electric charge according to an amount thereof into an external force applied to the end effector 7 .
- Such a piezoelectric material can adjust a direction to generate electric charge when an external force is applied according to the direction in which the element is placed.
- the respective elements 54 may detect forces Fz of components in the vertical directions and forces Fu about the z-axis, i.e., in u-axis directions. That is, the force detection unit 5 detects the forces Fz in the axial direction of the third axis O 3 . Thereby, the work of moving the shaft 241 along the z-axis directions may be performed more accurately.
- control apparatus 1 is coupled via the cable 200 .
- the control apparatus 1 includes the robot control unit 11 , a motor control unit 12 (end effector control unit), a display control unit 13 , a memory unit 14 , and a receiving unit 15 , and respectively controls driving of the respective parts of the robot system 100 including the robot 2 , the motor 72 of the end effector 7 , and the display device 41 .
- control apparatus 1 is configured to be respectively communicable among the robot control unit 11 , the motor control unit 12 , the display control unit 13 , the memory unit 14 , and the receiving unit 15 . That is, the robot control unit 11 , the motor control unit 12 , the display control unit 13 , the memory unit 14 , and the receiving unit 15 are coupled to one another in wired or wireless communication.
- the robot control unit 11 controls driving of the robot 2 , i.e., driving of the robot arm 20 etc.
- the robot control unit 11 is a computer in which programs of OS etc. are installed.
- the robot control unit 11 has e.g. a CPU as a processor, a RAM, and a ROM in which the programs are stored. Further, the function of the robot control unit 11 may be realized by e.g. execution of various programs using the CPU.
- the motor control unit 12 controls driving of the motor 72 .
- the motor control unit 12 is a computer in which programs of OS etc. are installed.
- the motor control unit 12 has e.g. a CPU as a processor, a RAM, and a ROM in which the programs are stored. Further, the function of the motor control unit 12 may be realized by e.g. execution of various programs using the CPU.
- the display control unit 13 has a function of displaying various screens such as windows, characters, etc. on the display device 41 . That is, the display control unit 13 controls driving of the display device 41 .
- the function of the display control unit 13 may be realized by e.g. a GPU or the like.
- the memory unit 14 has a function of storing various kinds of information including data and programs.
- the memory unit 14 stores control programs etc.
- the function of the memory unit 14 may be realized by the so-called external memory device such as a ROM.
- the receiving unit 15 has a function of receiving input from the input device 42 .
- the function of the receiving unit 15 may be realized using e.g. an interface circuit. Note that, for example, when a touch panel is used, the receiving unit 15 has a function as an input sensing unit that senses contact of a user's finger with the touch panel or the like.
- the display device 41 includes a monitor (not shown) formed using e.g. a liquid crystal display, EL display, or the like, and has a function of displaying various images including various screens such as windows, characters, etc.
- the input device 42 includes e.g. a mouse, keyboard, etc. Therefore, the user operates the input device 42 , and thereby, may give instructions of various kinds of processing etc. to the control apparatus 1 .
- the user may give instructions to the control apparatus 1 by an operation of clicking the various screens such as windows displayed on the display device 41 with the mouse of the input device 42 and an operation of inputting characters, numerals, etc. with the keyboard of the input device 42 .
- a display input device serving as both the display device 41 and the input device 42 may be provided.
- the display input device e.g. a touch panel such as an electrostatic touch panel or pressure-sensitive touch panel may be used.
- the input device 42 may recognize sound including voice.
- the robot arm 20 , the base 21 , and the force detection unit 5 have the following position relationship.
- a position relationship among the first axis O 1 , a center line S 2 , a center line S 21 (first center line) of the base 21 , the center line S 5 (second center line) of the force detection unit 5 will be explained using FIG. 5 .
- the first axis O 1 is a rotation axis of the first arm 22 coupled to the base 21 . Further, the first axis O 1 is parallel to the z-axis.
- the center line S 2 passes through a center of gravity G of the robot 2 and is parallel to the z-axis, i.e., the first axis O 1 .
- the position of the center of gravity G of the robot 2 is displaced according to the posture of the robot arm 20 , and the center line S 2 is displaced within an area A 2 shown in FIG. 5 .
- the area A 2 is a space having widths in the x-axis directions and the y-axis directions.
- the home position refers to a state in which the first arm 22 and the second arm 23 extend along the y-axis at rest.
- the home position refers to a state in which the third axis O 3 is farthest from the first axis O 1 and a pipe 8 shown in FIG. 1 appears as a linear shape as seen from the z-axis directions.
- the center line S 21 of the base 21 is a line passing through the center of the base 21 and being parallel to the first axis O 1 .
- the center of the base 21 refers to a center of gravity in a projected shape formed by projection of the base 21 from the z-axis directions. That is, the center refers to the geometric center of the projected shape formed by projection of the base 21 from the z-axis directions.
- the center line S 5 of the force detection unit 5 refers to a line passing through the center of the circle on which the respective elements 54 are placed and being parallel to the z-axis, i.e., the first axis O 1 .
- the center line S 5 is located closer to the first axis O 1 than the center line S 21 . That is, the center line S 5 is closer to the first axis O 1 than the center line S 21 .
- the robot arm 20 is coupled to the position shifted from the center line S 21 of the base 21 . That is, the center line S 21 of the base 21 and the first axis O 1 are located in different positions. Accordingly, the center of gravity G of the robot 2 is located in a position shifted from the center line S 21 of the base 21 . Therefore, in the force detection unit 5 , inertial moment shown by an arrow in FIG. 5 is generated due to the weight of the robot 2 itself. As a result, a force is constantly applied to the force detection unit 5 by the influence of the inertial moment.
- the force detection unit 5 detects the force F 1 .
- a force F 2 is applied to the force detection unit 5 by the influence thereof.
- the force detection unit 5 detects a force F 3 as a force (F 1 -F 2 ).
- the control apparatus 1 controls the robot arm 20 based on a difference between the force F 3 and the force F 1 detected by the force detection unit 5 , i.e., an amount of change of the force detected by the force detection unit 5 .
- the force F 1 is larger than the force F 2 , the amount of change is smaller. Accordingly, for example, when the force F 2 is smaller, the accurate detection of the force F 2 may be difficult.
- the force detection unit 5 is placed so that the center line S 5 may be closer to the first axis O 1 than the center line S 21 .
- the distance between the center of gravity G of the robot 2 and the center line S 5 of the force detection unit 5 may be made smaller than that in related art. Therefore, the force F 1 constantly applied to the force detection unit 5 by the influence of the inertial moment as shown by the arrow in FIG. 5 may be made smaller.
- the detection accuracy of the force detection unit 5 may be improved in this way.
- the first axis O 1 and the center line S 5 as the second center line overlap as seen from the axial direction of the first axis O 1 . That is, the first axis O 1 and the center line S 5 coincide. Thereby, the inertial moment about the first axis O 1 generated when the first arm 22 rotates may be detected more accurately.
- a separation distance between the center line S 21 and the third axis O 3 is L 1
- a separation distance between the center line S 21 and the center line S 5 is L 2
- a separation distance between the center line S 5 and the center line S 2 is L 3
- a separation distance between the center line S 21 and the first axis O 1 is L 4
- a height from the force detection unit 5 to the center of gravity G is L 5
- L 1 to L 5 preferably satisfy the following relationships.
- L 2 /L 1 preferably satisfies 0.01 ⁇ L 2 /L 1 ⁇ 0.8 and more preferably satisfies 0.05 ⁇ L 2 /L 1 ⁇ 0.6. Thereby, the detection accuracy of the force detection unit 5 may be effectively improved.
- L 2 /L 1 is too small, the center of gravity G shifts in a direction away from the force detection unit 5 , the force F 1 constantly applied to the force detection unit 5 tends to be too large, and the detection accuracy may be lower.
- L 2 /L 1 is too large, it is harder to place the base 21 on the force detection unit 5 with balance.
- L 2 /L 3 preferably satisfies 0.1 L 2 /L 3 6.0 and more preferably satisfies 0.2 L 2 /L 3 4.0.
- the detection accuracy of the force detection unit 5 may be effectively improved.
- L 2 /L 3 is too small, the center of gravity G shifts in a direction away from the force detection unit 5 , the force F 1 constantly applied to the force detection unit 5 tends to be too large, and the detection accuracy may be lower.
- L 2 /L 3 is too large, it is harder to place the base 21 on the force detection unit 5 with balance.
- L 2 L 4 and the preferable numerical range of L 4 /L 3 is the same as the above described numerical range of L 2 /L 3 .
- L 2 /L 5 preferably satisfies 0.05 L 2 /L 5 3.0 and more preferably satisfies 0.1 L 2 /L 5 1.0.
- the detection accuracy of the force detection unit 5 may be effectively improved.
- L 2 /L 5 is too small, the force F 1 constantly applied to the force detection unit 5 tends to be too large, and the detection accuracy may be lower.
- L 2 /L 5 is too large, it is harder to place the base 21 on the force detection unit 5 with balance.
- the robot 2 includes the base 21 , the robot arm 20 having the first arm 22 coupled to the base 21 and rotating about the first axis O 1 , and the force detection unit 5 provided in the base 21 and detecting the force acting on the base 21 or the robot arm 20 .
- the first arm 22 is coupled to the base 21 in the position shifted from the center line S 21 as the first center line passing through the center of the base 21 and being parallel to the first axis O 1 .
- the center line S 5 as the second center line passing through the center of the force detection unit 5 and being parallel to the first axis O 1 is closer to the first axis O 1 than the center line S 21 as the first center line.
- the distance between the center of gravity G of the robot 2 and the center line S 5 of the force detection unit 5 may be made smaller than that in related art. Therefore, the force F 1 constantly applied to the force detection unit 5 by the influence of the inertial moment as shown by the arrow in FIG. 5 may be made smaller. Thus, even when the amount of change of the force detected by the force detection unit 5 is larger relative to the force F 1 and the external force F 2 is smaller, the external force F 2 may be accurately detected. According to the present disclosure, the detection accuracy of the force detection unit 5 may be improved in this way.
- FIG. 6 is the schematic diagram of the second embodiment of the robot according to the present disclosure.
- the center line S 5 is located between the first axis O 1 and the center line S 21 as seen from the x-axis directions. That is, in a plan view of a plane containing the first axis O 1 and the center line S 21 as the first center line, the center line S 5 as the second center line is located between the first axis O 1 and the center line S 21 as the first center line.
- the force detection unit 5 may be placed closer to the center portion of the base 21 than that of the first embodiment and the force detection unit 5 may support the base 21 more stably.
- the first axis O 1 , the center line S 5 , and the center line S 21 are located on the same plane, however, not limited thereto, these are not necessarily located on the same plane.
- FIG. 7 is the schematic diagram of the third embodiment of the robot according to the present disclosure.
- the center line S 5 is located between the center line S 2 and the first axis O 1 as seen from the x-axis directions. That is, in the plan view of the plane containing the first axis O 1 and the center line S 21 as the first center line, the center line S 5 as the second center line passes through the center of gravity G of the robot 2 and is located between the center line S 2 as the line parallel to the first axis O 1 and the first axis O 1 .
- the effects of the present disclosure may be obtained and the force F 1 constantly applied to the force detection unit 5 by the influence of the inertial moment as shown by an arrow in FIG. 7 may be made smaller because the center line S 5 is closer to the center line S 2 than those in the above described respective embodiments.
- the first axis O 1 , the center line S 5 , and the center line S 21 are located on the same plane, however, not limited thereto, these are not necessarily located on the same plane.
- the robot according to the present disclosure is explained based on the illustrated embodiments, however, the present disclosure is not limited to those.
- the configurations of the respective parts may be replaced by arbitrary configurations having the same functions. Further, another arbitrary configuration may be added. Furthermore, the features of the respective embodiments may be combined.
- the number of rotation axes of the robot arm is three, however, the number is not limited to that in the present disclosure.
- the number of rotation axes of the robot arm may be e.g. two, four, or more. That is, in the above described embodiments, the number of arms is three, however, the number is not limited to that in the present disclosure.
- the number of arms may be e.g. two, four, or more.
Abstract
Description
- The present application is based on, and claims priority from JP Application Serial Number 2019-119690, filed Jun. 27, 2019, the disclosure of which is hereby incorporated by reference herein in its entirety.
- The present disclosure relates to a robot.
- Recently, in factories, due to labor cost rise and labor shortage, work manually performed in the past has been increasingly automated by various robots and robot peripherals. The various robots include e.g. bases, arms supported by the bases, and force sensors as shown in JP-A-2018-080941. In the robots, the arms are controlled based on detection results of the force sensors.
- In the robot disclosed in JP-A-2018-080941, the force sensor is provided below the base. Accordingly, load of the base and the arm is applied onto the force sensor. During actuation of the robot, for example, when an external force is applied to the arm, the force is transmitted to the force sensor via the arm and the base. The force may be detected and the arm may be controlled based on the detection result.
- However, when the arm is coupled to a position shifted from a center line of the base, in the configuration as shown in JP-A-2018-080941, i.e., the configuration in which the center axis of the force sensor and the center axis of the base coincide, torque under the arm's weight is constantly applied to the force sensor. The detection accuracy of the force sensor may be lower depending on the magnitude of the torque.
- The present disclosure can be implemented as follows.
- A robot according to an application example includes a base, a robot arm having a first arm coupled to the base and rotating about a first axis, and a force detection unit provided in the base and detecting a force acting on the base or the robot arm, wherein the first arm is coupled to the base in a position shifted from a first center line passing through a center of the base and being parallel to the first axis, and a second center line passing through a center of the force detection unit and being parallel to the first axis is closer to the first axis than the first center line.
-
FIG. 1 is a side view showing a first embodiment of a robot system including a robot according to the present disclosure. -
FIG. 2 is a block diagram of the robot system shown inFIG. 1 . -
FIG. 3 is a side view of a force detection unit shown inFIG. 1 . -
FIG. 4 is a sectional view along line A-A inFIG. 3 . -
FIG. 5 is a schematic diagram of the robot shown inFIG. 1 . -
FIG. 6 is a schematic diagram of a second embodiment of the robot according to the present disclosure. -
FIG. 7 is a schematic diagram of a third embodiment of the robot according to the present disclosure. - As below, a robot according to the present disclosure will be explained in detail based on preferred embodiments shown in the accompanying drawings.
-
FIG. 1 is the side view showing the first embodiment of the robot system including the robot according to the present disclosure.FIG. 2 is the block diagram of the robot system shown inFIG. 1 .FIG. 3 is the side view of the force detection unit shown inFIG. 1 .FIG. 4 is the sectional view along line A-A inFIG. 3 .FIG. 5 is the schematic diagram of the robot shown inFIG. 1 . - In
FIGS. 1 and 3 to 7 , for convenience of explanation, an x-axis, a y-axis, and a z-axis are shown as three axes orthogonal to one another. Hereinafter, directions parallel to the x-axis are also referred to as “x-axis directions”, directions parallel to the y-axis are also referred to as “y-axis directions”, and directions parallel to the z-axis are also referred to as “z-axis directions”. Further, hereinafter, the head sides of the respective arrows are referred to as “+(plus)” and tail sides are referred to as “− (minus)”, a direction parallel to the +x-axis direction is also referred to as “+x-axis direction”, a direction parallel to the −x-axis direction is also referred to as “−x-axis direction”, a direction parallel to the +y-axis direction is also referred to as “+y-axis direction”, a direction parallel to the −y-axis direction is also referred to as “−y-axis direction”, a direction parallel to the +z-axis direction is also referred to as “+z-axis direction”, and a direction parallel to the −z-axis direction is also referred to as “−z-axis direction”. Furthermore, a direction about the z-axis and a direction about an axis parallel to the z-axis are also referred to as “u-axis directions”. - Hereinafter, for convenience of explanation, the +z-axis direction in
FIG. 1 , i.e., the upside is also referred to as “upper” or “above” and the −z-axis direction, i.e., the downside is also referred to as “lower” or “below”. Further, regarding arobot arm 20, a side of abase 21 inFIG. 1 is referred to as “proximal end” and the opposite side, i.e., a side of an end effector 7 is referred to as “distal end”. Furthermore, the z-axis directions inFIG. 1 , i.e., upward and downward directions are referred to as “vertical directions” and the x-axis directions and the y-axis directions, i.e., leftward and rightward directions are referred to as “horizontal directions”. - A
robot system 100 shown inFIGS. 1 and 2 is an apparatus used for work of e.g. holding, transport, assembly, inspection, etc. of works including electronic components and electronic apparatuses. Therobot system 100 includes a control apparatus 1, arobot 2, and the end effector 7. Additionally, therobot system 100 includes adisplay device 41, aninput device 42, etc. - The control apparatus 1 is placed in a position different from that of the
robot 2, i.e., outside of therobot 2. Further, in the illustrated configuration, therobot 2 and the control apparatus 1 are electrically coupled (hereinafter, also simply referred to as “coupled”) by a cable 200, however, not limited thereto the cable 200 may be omitted for wireless communication. That is, therobot 2 and the control apparatus 1 may be connected in wired communication or connected in wireless communication. Further, the control apparatus 1 may be provided inside of thebase 21 of therobot 2. - In the illustrated configuration, the
robot 2 is a horizontal articulated robot, i.e., a scalar robot. - As shown in
FIG. 1 , therobot 2 includes thebase 21, afirst arm 22, asecond arm 23, athird arm 24 as a working head, and aforce detection unit 5. Thefirst arm 22, thesecond arm 23, and thethird arm 24 form therobot arm 20. - Further, the
robot 2 includes adrive unit 25 that rotates thefirst arm 22 relative to thebase 21, adrive unit 26 that rotates thesecond arm 23 relative to thefirst arm 22, au-drive unit 27 that rotates ashaft 241 of thethird arm 24 relative to thesecond arm 23, a z-drive unit that moves theshaft 241 in the z-axis directions relative to thesecond arm 23, and anangular velocity sensor 29. - As described above, the
robot 2 includes thebase 21 rotatably supporting therobot arm 20, and therobot arm 20 includes thefirst arm 22 and thesecond arm 23 located at the distal side of thefirst arm 22 with respect to thebase 21. Thereby, the movable range of therobot arm 20 may be increased. - As shown in
FIGS. 1 and 2 , thedrive unit 25 is provided within ahousing 220 of thefirst arm 22, and has amotor 251 that generates a driving force, areducer 252 that reduces the driving force of themotor 251, and aposition sensor 253 that detects the rotation angle of the rotation shaft of themotor 251 or thereducer 252. - The
drive unit 26 is provided within ahousing 230 of thesecond arm 23, and has amotor 261 that generates a driving force, areducer 262 that reduces the driving force of themotor 261, and aposition sensor 263 that detects the rotation angle of the rotation shaft of themotor 261 or thereducer 262. - The
u-drive unit 27 is provided within thehousing 230 of thesecond arm 23, and has amotor 271 that generates a driving force, areducer 272 that reduces the driving force of themotor 271, and aposition sensor 273 that detects the rotation angle of the rotation shaft of themotor 271 or thereducer 272. - The z-
drive unit 28 is provided within thehousing 230 of thesecond arm 23, and has amotor 281 that generates a driving force, areducer 282 that reduces the driving force of themotor 281, and aposition sensor 283 that detects the rotation angle of the rotation shaft of themotor 281 or thereducer 282. - As the
motor 251, themotor 261, themotor 271, and themotor 281, e.g. servo motors such as AC servo motors or DC servo motors may be used. - As the
reducer 252, thereducer 262, thereducer 272, and thereducer 282, e.g. planet-gear reducers, wave gearings, or the like may be used. As theposition sensor 253, theposition sensor 263, theposition sensor 273, and theposition sensor 283, e.g. angle sensors may be used. - The
drive unit 25, thedrive unit 26, theu-drive unit 27, and the z-drive unit 28 are respectively coupled to corresponding motor drivers (not shown) and controlled by a robot control unit 11 of the control apparatus 1 via the motor drivers. - As shown in
FIG. 1 , theangular velocity sensor 29 is provided inside of thesecond arm 23. Accordingly, the angular velocity of thesecond arm 23 may be detected. The control apparatus 1 performs control of therobot 2 based on information of the detected angular velocity. - The
base 21 is fixed to e.g. a floor surface (not shown) by bolts or the like. Thefirst arm 22 is coupled to the upper end portion of thebase 21. Thefirst arm 22 is rotatable about a first axis O1 along the vertical directions relative to thebase 21. When thedrive unit 25 that rotates thefirst arm 22 is driven, thefirst arm 22 rotates about the first axis O1 within the horizontal plane relative to thebase 21. Theposition sensor 253 may detect the amount of rotation of thefirst arm 22 relative to thebase 21. - The
second arm 23 is coupled to the distal end portion of thefirst arm 22. Thesecond arm 23 is rotatable about a second axis O2 along the vertical directions relative to thefirst arm 22. The axial direction of the first axis O1 and the axial direction of the second axis O2 are the same. That is, the second axis O2 is parallel to the first axis O1. When thedrive unit 26 that rotates thesecond arm 23 is driven, thesecond arm 23 rotates about the second axis O2 within the horizontal plane relative to thefirst arm 22. Theposition sensor 263 may detect the amount of drive, specifically, the amount of rotation of thesecond arm 23 relative to thefirst arm 22. - The
third arm 24 is placed and supported in the distal end portion of thesecond arm 23. Thethird arm 24 has theshaft 241. Theshaft 241 is rotatable about a third axis O3 along the vertical directions relative to thesecond arm 23 and movable in the upward and downward directions. Theshaft 241 is an arm at the most distal end of therobot arm 20. - When the
u-drive unit 27 that rotates theshaft 241 is driven, theshaft 241 forwardly and reversely rotates about the z-axis, that is, turns. Theposition sensor 273 may detect the amount of rotation of theshaft 241 relative to thesecond arm 23. - When the z-
drive unit 28 that moves theshaft 241 in the z-axis directions is driven, theshaft 241 moves in the upward and downward directions, i.e., the z-axis directions. Theposition sensor 283 may detect the amount of movement of theshaft 241 in the z-axis directions relative to thesecond arm 23. - As described above, the
robot arm 20 has thefirst arm 22, thesecond arm 23 coupled to thefirst arm 22 at an opposite side to thebase 21 and rotating about the second axis O2 parallel to the first axis O1, and thethird arm 24 supported by thesecond arm 23 and moving along an axial direction of the third axis O3 in a position different from that of the second axis O2 in parallel to the second axis O2. The movable range on the xy-plane may be sufficiently secured by thefirst arm 22 and thesecond arm 23, and actuation in the z-axis directions may be performed by thethird arm 24. - Various end effectors are detachably coupled to the distal end portion of the
shaft 241. The end effectors are not particularly limited to, but include e.g. an end effector that grips an object to be transported, an end effector that processes a workpiece, an end effector used for an inspection, etc. In the embodiment, the end effector is detachably coupled. The end effector 7 will be described later in detail. - Note that the end effector 7 is not a component element of the
robot 2 in the embodiment, however, a part or all of the end effector 7 may be a component element of therobot 2. Further, the end effector 7 is not a component element of therobot arm 20 in the embodiment, however, a part or all of the end effector 7 may be a component element of therobot arm 20. - As shown in
FIG. 1 , the end effector 7 has an attachment portion 71 attached to theshaft 241, amotor 72 provided in the attachment portion 71, and a screw limit gauge 3 detachably and coaxially attached to the rotation shaft of themotor 72. The end effector 7 is detachably coupled to the distal end portion of theshaft 241. - The
motor 72 is not particularly limited, but e.g. a servo motor such as an AC servo motor or DC servo motor, stepping motor, or the like is used. - Further, the end effector 7 has an angle sensor (not shown) that detects the rotation angle of the rotation shaft of the
motor 72, and the angle sensor may detect the rotation angle of the rotation shaft of themotor 72. - In the end effector 7, compared to a case where a power transmission mechanism including a gear and a belt intervenes between the rotation shaft of the
motor 72 and the screw limit gauge 3, lowering of the rotation accuracy due to backlash may be suppressed. - In the embodiment, the end effector 7 is detachable from the
robot arm 20, however, not limited thereto, for example, the end effector 7 may be undetachable from therobot arm 20. - Next, the
force detection unit 5 will be explained. - As shown in
FIGS. 1 and 3 , theforce detection unit 5 detects a force applied to therobot 2, i.e., a force applied to therobot arm 20 and thebase 21. Theforce detection unit 5 is provided under thebase 21, i.e., at the −z-axis side and supports the base 21 from underneath. Accordingly, a load of the weights of therobot arm 20 and thebase 21 is applied onto theforce detection unit 5. - Further, as shown in
FIG. 3 , theforce detection unit 5 is a member in a cylindrical outer shape having afirst plate 51, asecond plate 52, atubular portion 53 placed between thefirst plate 51 and thesecond plate 52, and a plurality of, in the embodiment, fourelements 54. The fourelements 54 are sandwiched between thefirst plate 51 and thesecond plate 52. The number of theelements 54 is not limited to that, but may be three or less or five or more. - The
first plate 51 and thesecond plate 52 have circular disc shapes and are sequentially placed from the +z-axis side. Note that the shapes of thefirst plate 51 and thesecond plate 52 in a plan view are not limited to the circular shapes, but may be any shapes. - The
tubular portion 53 has a cylindrical shape in the embodiment and has a function of protecting theelements 54. - The
respective elements 54 are placed at equal intervals to form a circular shape. Thereby, forces applied to therespective elements 54 may be as uniform as possible and the forces may be accurately detected. Here, in this specification, a line passing through the center of a circle C on which therespective elements 54 are placed and being parallel to the z-axis, i.e., the first axis O1 is referred to as “center line S5”. In the embodiment, the center of theforce detection unit 5 is the center of the circle C on which therespective elements 54 are placed. However, when therespective elements 54 are not circularly placed, the geometric center of a figure with therespective elements 54 as vertices is referred to as the center of theforce detection unit 5. - As the
respective elements 54, elements formed using e.g. piezoelectric materials such as quartz crystal and outputting electric charge by application of external force may be employed. The control apparatus 1 may convert the electric charge according to an amount thereof into an external force applied to the end effector 7. Such a piezoelectric material can adjust a direction to generate electric charge when an external force is applied according to the direction in which the element is placed. - In the embodiment, as shown in
FIG. 4 , therespective elements 54 may detect forces Fz of components in the vertical directions and forces Fu about the z-axis, i.e., in u-axis directions. That is, theforce detection unit 5 detects the forces Fz in the axial direction of the third axis O3. Thereby, the work of moving theshaft 241 along the z-axis directions may be performed more accurately. - In the
robot 2, the control apparatus 1 is coupled via the cable 200. - As shown in
FIG. 2 , the control apparatus 1 includes the robot control unit 11, a motor control unit 12 (end effector control unit), adisplay control unit 13, amemory unit 14, and a receivingunit 15, and respectively controls driving of the respective parts of therobot system 100 including therobot 2, themotor 72 of the end effector 7, and thedisplay device 41. - Further, the control apparatus 1 is configured to be respectively communicable among the robot control unit 11, the
motor control unit 12, thedisplay control unit 13, thememory unit 14, and the receivingunit 15. That is, the robot control unit 11, themotor control unit 12, thedisplay control unit 13, thememory unit 14, and the receivingunit 15 are coupled to one another in wired or wireless communication. - The robot control unit 11 controls driving of the
robot 2, i.e., driving of therobot arm 20 etc. The robot control unit 11 is a computer in which programs of OS etc. are installed. The robot control unit 11 has e.g. a CPU as a processor, a RAM, and a ROM in which the programs are stored. Further, the function of the robot control unit 11 may be realized by e.g. execution of various programs using the CPU. - The
motor control unit 12 controls driving of themotor 72. Themotor control unit 12 is a computer in which programs of OS etc. are installed. Themotor control unit 12 has e.g. a CPU as a processor, a RAM, and a ROM in which the programs are stored. Further, the function of themotor control unit 12 may be realized by e.g. execution of various programs using the CPU. - The
display control unit 13 has a function of displaying various screens such as windows, characters, etc. on thedisplay device 41. That is, thedisplay control unit 13 controls driving of thedisplay device 41. The function of thedisplay control unit 13 may be realized by e.g. a GPU or the like. - The
memory unit 14 has a function of storing various kinds of information including data and programs. Thememory unit 14 stores control programs etc. The function of thememory unit 14 may be realized by the so-called external memory device such as a ROM. - The receiving
unit 15 has a function of receiving input from theinput device 42. The function of the receivingunit 15 may be realized using e.g. an interface circuit. Note that, for example, when a touch panel is used, the receivingunit 15 has a function as an input sensing unit that senses contact of a user's finger with the touch panel or the like. - The
display device 41 includes a monitor (not shown) formed using e.g. a liquid crystal display, EL display, or the like, and has a function of displaying various images including various screens such as windows, characters, etc. - The
input device 42 includes e.g. a mouse, keyboard, etc. Therefore, the user operates theinput device 42, and thereby, may give instructions of various kinds of processing etc. to the control apparatus 1. - Specifically, the user may give instructions to the control apparatus 1 by an operation of clicking the various screens such as windows displayed on the
display device 41 with the mouse of theinput device 42 and an operation of inputting characters, numerals, etc. with the keyboard of theinput device 42. - Note that, in the embodiment, in place of the
display device 41 and theinput device 42, a display input device serving as both thedisplay device 41 and theinput device 42 may be provided. As the display input device, e.g. a touch panel such as an electrostatic touch panel or pressure-sensitive touch panel may be used. Or, theinput device 42 may recognize sound including voice. - In the
robot 2, therobot arm 20, thebase 21, and theforce detection unit 5 have the following position relationship. As below, a position relationship among the first axis O1, a center line S2, a center line S21 (first center line) of thebase 21, the center line S5 (second center line) of theforce detection unit 5 will be explained usingFIG. 5 . - As described above, the first axis O1 is a rotation axis of the
first arm 22 coupled to thebase 21. Further, the first axis O1 is parallel to the z-axis. - The center line S2 passes through a center of gravity G of the
robot 2 and is parallel to the z-axis, i.e., the first axis O1. The position of the center of gravity G of therobot 2 is displaced according to the posture of therobot arm 20, and the center line S2 is displaced within an area A2 shown inFIG. 5 . The area A2 is a space having widths in the x-axis directions and the y-axis directions. - As below, the explanation will be made on the assumption that the center of gravity G of the
robot 2 refers to a center of gravity when therobot arm 20 is located in a home position. As shown inFIG. 1 , the home position refers to a state in which thefirst arm 22 and thesecond arm 23 extend along the y-axis at rest. In other words, the home position refers to a state in which the third axis O3 is farthest from the first axis O1 and a pipe 8 shown inFIG. 1 appears as a linear shape as seen from the z-axis directions. - The center line S21 of the
base 21 is a line passing through the center of thebase 21 and being parallel to the first axis O1. In the embodiment, the center of thebase 21 refers to a center of gravity in a projected shape formed by projection of the base 21 from the z-axis directions. That is, the center refers to the geometric center of the projected shape formed by projection of the base 21 from the z-axis directions. - As described above, the center line S5 of the
force detection unit 5 refers to a line passing through the center of the circle on which therespective elements 54 are placed and being parallel to the z-axis, i.e., the first axis O1. - In the present disclosure, as shown in
FIG. 5 , the center line S5 is located closer to the first axis O1 than the center line S21. That is, the center line S5 is closer to the first axis O1 than the center line S21. Thereby, the following advantages are obtained. - As described above, in the
robot 2, therobot arm 20 is coupled to the position shifted from the center line S21 of thebase 21. That is, the center line S21 of thebase 21 and the first axis O1 are located in different positions. Accordingly, the center of gravity G of therobot 2 is located in a position shifted from the center line S21 of thebase 21. Therefore, in theforce detection unit 5, inertial moment shown by an arrow inFIG. 5 is generated due to the weight of therobot 2 itself. As a result, a force is constantly applied to theforce detection unit 5 by the influence of the inertial moment. - In a case where the force constantly applied to the
force detection unit 5 is a force F1, when an external force is not applied to thethird arm 24, theforce detection unit 5 detects the force F1. When an external force in the direction of the arrow inFIG. 5 is applied to thethird arm 24, a force F2 is applied to theforce detection unit 5 by the influence thereof. At the time, theforce detection unit 5 detects a force F3 as a force (F1-F2). Then, the control apparatus 1 controls therobot arm 20 based on a difference between the force F3 and the force F1 detected by theforce detection unit 5, i.e., an amount of change of the force detected by theforce detection unit 5. - When the force F1 is larger than the force F2, the amount of change is smaller. Accordingly, for example, when the force F2 is smaller, the accurate detection of the force F2 may be difficult.
- Accordingly, as described above, in the present disclosure, the
force detection unit 5 is placed so that the center line S5 may be closer to the first axis O1 than the center line S21. Thereby, the distance between the center of gravity G of therobot 2 and the center line S5 of theforce detection unit 5 may be made smaller than that in related art. Therefore, the force F1 constantly applied to theforce detection unit 5 by the influence of the inertial moment as shown by the arrow inFIG. 5 may be made smaller. Thus, even when the amount of change of the force detected by theforce detection unit 5 is larger relative to the force F1 and the force F2 is smaller, the force F2 may be accurately detected. According to the present disclosure, the detection accuracy of theforce detection unit 5 may be improved in this way. - In the embodiment, the first axis O1 and the center line S5 as the second center line overlap as seen from the axial direction of the first axis O1. That is, the first axis O1 and the center line S5 coincide. Thereby, the inertial moment about the first axis O1 generated when the
first arm 22 rotates may be detected more accurately. - When a separation distance between the center line S21 and the third axis O3 is L1, a separation distance between the center line S21 and the center line S5 is L2, a separation distance between the center line S5 and the center line S2 is L3, a separation distance between the center line S21 and the first axis O1 is L4, and a height from the
force detection unit 5 to the center of gravity G is L5, L1 to L5 preferably satisfy the following relationships. - In the
robot 2, L2/L1 preferably satisfies 0.01≤L2/L1≤0.8 and more preferably satisfies 0.05≤L2/L1≤0.6. Thereby, the detection accuracy of theforce detection unit 5 may be effectively improved. When L2/L1 is too small, the center of gravity G shifts in a direction away from theforce detection unit 5, the force F1 constantly applied to theforce detection unit 5 tends to be too large, and the detection accuracy may be lower. On the other hand, when L2/L1 is too large, it is harder to place thebase 21 on theforce detection unit 5 with balance. - Further, in the
robot 2, L2/L3 preferably satisfies 0.1 L2/L3 6.0 and more preferably satisfies 0.2 L2/L3 4.0. Thereby, the detection accuracy of theforce detection unit 5 may be effectively improved. When L2/L3 is too small, the center of gravity G shifts in a direction away from theforce detection unit 5, the force F1 constantly applied to theforce detection unit 5 tends to be too large, and the detection accuracy may be lower. On the other hand, when L2/L3 is too large, it is harder to place thebase 21 on theforce detection unit 5 with balance. - Note that, in the embodiment, L2=L4 and the preferable numerical range of L4/L3 is the same as the above described numerical range of L2/L3.
- Furthermore, in the
robot 2, L2/L5 preferably satisfies 0.05 L2/L5 3.0 and more preferably satisfies 0.1 L2/L5 1.0. Thereby, the detection accuracy of theforce detection unit 5 may be effectively improved. When L2/L5 is too small, the force F1 constantly applied to theforce detection unit 5 tends to be too large, and the detection accuracy may be lower. On the other hand, when L2/L5 is too large, it is harder to place thebase 21 on theforce detection unit 5 with balance. - As described above, the
robot 2 includes thebase 21, therobot arm 20 having thefirst arm 22 coupled to thebase 21 and rotating about the first axis O1, and theforce detection unit 5 provided in thebase 21 and detecting the force acting on the base 21 or therobot arm 20. Further, thefirst arm 22 is coupled to the base 21 in the position shifted from the center line S21 as the first center line passing through the center of thebase 21 and being parallel to the first axis O1. The center line S5 as the second center line passing through the center of theforce detection unit 5 and being parallel to the first axis O1 is closer to the first axis O1 than the center line S21 as the first center line. Thereby, the distance between the center of gravity G of therobot 2 and the center line S5 of theforce detection unit 5 may be made smaller than that in related art. Therefore, the force F1 constantly applied to theforce detection unit 5 by the influence of the inertial moment as shown by the arrow inFIG. 5 may be made smaller. Thus, even when the amount of change of the force detected by theforce detection unit 5 is larger relative to the force F1 and the external force F2 is smaller, the external force F2 may be accurately detected. According to the present disclosure, the detection accuracy of theforce detection unit 5 may be improved in this way. -
FIG. 6 is the schematic diagram of the second embodiment of the robot according to the present disclosure. - As below, the second embodiment of the robot according to the present disclosure will be explained with reference to
FIG. 6 , and the explanation will be made with a focus on the differences from the above described embodiment and the explanation of the same items will be omitted. - As shown in
FIG. 6 , in the embodiment, the center line S5 is located between the first axis O1 and the center line S21 as seen from the x-axis directions. That is, in a plan view of a plane containing the first axis O1 and the center line S21 as the first center line, the center line S5 as the second center line is located between the first axis O1 and the center line S21 as the first center line. Thereby, the effects of the present disclosure may be obtained and theforce detection unit 5 may be placed closer to the center portion of the base 21 than that of the first embodiment and theforce detection unit 5 may support the base 21 more stably. - Note that, in the embodiment, the first axis O1, the center line S5, and the center line S21 are located on the same plane, however, not limited thereto, these are not necessarily located on the same plane.
-
FIG. 7 is the schematic diagram of the third embodiment of the robot according to the present disclosure. - As below, the third embodiment of the robot according to the present disclosure will be explained with reference to
FIG. 7 , and the explanation will be made with a focus on the differences from the above described embodiments and the explanation of the same items will be omitted. - As shown in
FIG. 7 , in the embodiment, the center line S5 is located between the center line S2 and the first axis O1 as seen from the x-axis directions. That is, in the plan view of the plane containing the first axis O1 and the center line S21 as the first center line, the center line S5 as the second center line passes through the center of gravity G of therobot 2 and is located between the center line S2 as the line parallel to the first axis O1 and the first axis O1. Thereby, the effects of the present disclosure may be obtained and the force F1 constantly applied to theforce detection unit 5 by the influence of the inertial moment as shown by an arrow inFIG. 7 may be made smaller because the center line S5 is closer to the center line S2 than those in the above described respective embodiments. - Note that, in the embodiment, the first axis O1, the center line S5, and the center line S21 are located on the same plane, however, not limited thereto, these are not necessarily located on the same plane.
- As above, the robot according to the present disclosure is explained based on the illustrated embodiments, however, the present disclosure is not limited to those. The configurations of the respective parts may be replaced by arbitrary configurations having the same functions. Further, another arbitrary configuration may be added. Furthermore, the features of the respective embodiments may be combined.
- In the above described embodiments, the number of rotation axes of the robot arm is three, however, the number is not limited to that in the present disclosure. The number of rotation axes of the robot arm may be e.g. two, four, or more. That is, in the above described embodiments, the number of arms is three, however, the number is not limited to that in the present disclosure. The number of arms may be e.g. two, four, or more.
Claims (6)
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019119690A JP7375345B2 (en) | 2019-06-27 | 2019-06-27 | robot |
JPJP2019-119690 | 2019-06-27 | ||
JP2019-119690 | 2019-06-27 |
Publications (2)
Publication Number | Publication Date |
---|---|
US20200406451A1 true US20200406451A1 (en) | 2020-12-31 |
US11458616B2 US11458616B2 (en) | 2022-10-04 |
Family
ID=73887455
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US16/912,744 Active 2040-10-23 US11458616B2 (en) | 2019-06-27 | 2020-06-26 | Robot |
Country Status (3)
Country | Link |
---|---|
US (1) | US11458616B2 (en) |
JP (1) | JP7375345B2 (en) |
CN (1) | CN112140105B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11161257B2 (en) * | 2019-06-27 | 2021-11-02 | Seiko Epson Corporation | Robot |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006021287A (en) | 2004-07-09 | 2006-01-26 | Univ Waseda | Device for detecting contact force of robot |
JP6008112B2 (en) * | 2012-10-23 | 2016-10-19 | セイコーエプソン株式会社 | Horizontal articulated robot |
JP6193816B2 (en) * | 2014-06-20 | 2017-09-06 | ファナック株式会社 | Articulated robot with arm retracting function |
JP6300693B2 (en) * | 2014-09-30 | 2018-03-28 | セイコーエプソン株式会社 | robot |
JP3204177U (en) | 2016-03-01 | 2016-05-19 | 株式会社レプトリノ | Force detection system |
JP6342971B2 (en) | 2016-11-14 | 2018-06-13 | ファナック株式会社 | Force detection device and robot |
JP6862794B2 (en) * | 2016-11-24 | 2021-04-21 | セイコーエプソン株式会社 | Force detection sensor, force sensor, torque sensor and robot |
JP6450737B2 (en) | 2016-12-08 | 2019-01-09 | ファナック株式会社 | Robot system |
JP6878908B2 (en) | 2017-01-23 | 2021-06-02 | セイコーエプソン株式会社 | Encoders, robots and printers |
JP6988152B2 (en) * | 2017-05-08 | 2022-01-05 | セイコーエプソン株式会社 | robot |
JP2019042906A (en) | 2017-09-07 | 2019-03-22 | 株式会社不二越 | Device for doubly checking external contact of robot |
JP2019098407A (en) * | 2017-11-28 | 2019-06-24 | ファナック株式会社 | robot |
US11872698B2 (en) * | 2018-02-13 | 2024-01-16 | Canon Kabushiki Kaisha | Controller of robot and control method |
-
2019
- 2019-06-27 JP JP2019119690A patent/JP7375345B2/en active Active
-
2020
- 2020-06-23 CN CN202010578579.5A patent/CN112140105B/en active Active
- 2020-06-26 US US16/912,744 patent/US11458616B2/en active Active
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11161257B2 (en) * | 2019-06-27 | 2021-11-02 | Seiko Epson Corporation | Robot |
Also Published As
Publication number | Publication date |
---|---|
US11458616B2 (en) | 2022-10-04 |
JP2021003783A (en) | 2021-01-14 |
JP7375345B2 (en) | 2023-11-08 |
CN112140105B (en) | 2023-11-24 |
CN112140105A (en) | 2020-12-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10792812B2 (en) | Control device and robot system | |
US20170312922A1 (en) | Vibration measurement method for moving part, vibration measurement method for robot, and control device | |
US11420326B2 (en) | Horizontal articulated robot | |
US11161257B2 (en) | Robot | |
US20170120444A1 (en) | Robot, control apparatus, and robot system | |
US20180154520A1 (en) | Control device, robot, and robot system | |
US11458616B2 (en) | Robot | |
EP3409427A1 (en) | Control device, robot and control method | |
US11458625B2 (en) | Horizontal articulated robot and robot system | |
US11389948B2 (en) | Teaching method | |
CN112643683B (en) | Teaching method | |
JP7238489B2 (en) | Horizontal articulated robot | |
US11628563B2 (en) | Control method and robot system | |
US11969900B2 (en) | Teaching apparatus, control method, and teaching program | |
CN112743539B (en) | Robot system | |
US20210154845A1 (en) | Teaching apparatus, control method, and teaching program | |
WO2022163536A1 (en) | Displacement detecting sensor, control device, and control system | |
JP2018114593A (en) | robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AS | Assignment |
Owner name: SEIKO EPSON CORPORATION, JAPAN Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:KUROKAWA, JUNICHI;REEL/FRAME:053045/0425 Effective date: 20200526 |
|
FEPP | Fee payment procedure |
Free format text: ENTITY STATUS SET TO UNDISCOUNTED (ORIGINAL EVENT CODE: BIG.); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY |
|
STPP | Information on status: patent application and granting procedure in general |
Free format text: DOCKETED NEW CASE - READY FOR EXAMINATION |
|
STPP | Information on status: patent application and granting procedure in general |
Free format text: NON FINAL ACTION MAILED |
|
STPP | Information on status: patent application and granting procedure in general |
Free format text: NON FINAL ACTION MAILED |
|
STPP | Information on status: patent application and granting procedure in general |
Free format text: NOTICE OF ALLOWANCE MAILED -- APPLICATION RECEIVED IN OFFICE OF PUBLICATIONS |
|
STPP | Information on status: patent application and granting procedure in general |
Free format text: PUBLICATIONS -- ISSUE FEE PAYMENT VERIFIED |
|
STCF | Information on status: patent grant |
Free format text: PATENTED CASE |