WO2017043583A1 - ロボット装置 - Google Patents

ロボット装置 Download PDF

Info

Publication number
WO2017043583A1
WO2017043583A1 PCT/JP2016/076473 JP2016076473W WO2017043583A1 WO 2017043583 A1 WO2017043583 A1 WO 2017043583A1 JP 2016076473 W JP2016076473 W JP 2016076473W WO 2017043583 A1 WO2017043583 A1 WO 2017043583A1
Authority
WO
WIPO (PCT)
Prior art keywords
coordinate system
robot
hand
axis
button set
Prior art date
Application number
PCT/JP2016/076473
Other languages
English (en)
French (fr)
Inventor
宗祐 ▲高▼▲瀬▼
順央 川口
尹 祐根
眞二 栗原
Original Assignee
ライフロボティクス株式会社
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by ライフロボティクス株式会社 filed Critical ライフロボティクス株式会社
Priority to JP2017539221A priority Critical patent/JP6791859B2/ja
Priority to EP16844444.6A priority patent/EP3348360A4/en
Priority to CN201680065548.1A priority patent/CN108349089A/zh
Publication of WO2017043583A1 publication Critical patent/WO2017043583A1/ja
Priority to US15/918,426 priority patent/US20180207803A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/02Hand grip control means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/06Control stands, e.g. consoles, switchboards
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J18/00Arms
    • B25J18/02Arms extensible
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/06Programme-controlled manipulators characterised by multi-articulated arms
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10STECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00Robots
    • Y10S901/14Arm movement, spatial
    • Y10S901/15Jointed arm
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10STECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00Robots
    • Y10S901/27Arm part
    • Y10S901/28Joint

Definitions

  • the embodiment of the present invention relates to a robot apparatus.
  • Some robot apparatuses have a vertical articulated arm mechanism.
  • the vertical multi-joint arm mechanism is generally equipped with joints J1, J2, and J3 called the root three axes and joints J4, J5, and J6 called the wrist three axes.
  • joints J1-J6 are individually or in conjunction with each other to move the hand and arbitrarily change the hand posture.
  • the hand moves by the individual driving of the root joints J1, J2, J3, and the hand posture is changed by the individual driving of the wrist joints J4, J5, J6. It is possible to change the hand posture in a state where the hand posture is fixed (translational movement) and the hand position is fixed by interlocking control of these joint portions.
  • the user selects one of the world coordinate system, robot coordinate system, or user coordinate system as the reference coordinate system, and any of wrist coordinate system, hand coordinate system (tool coordinate system), or work coordinate system This can be selected as the target coordinate system, and the operation space can be suitably defined according to the application environment of the robot apparatus.
  • the origin of the target coordinate system with respect to the reference coordinate system is displaced, and the relative angle of the target coordinate system with respect to the reference coordinate system is fixed.
  • the target coordinate system is rotated around each of the three orthogonal axes while the origin of the target coordinate system on the reference coordinate system is fixed. Since the reference coordinate system and the target coordinate system can be arbitrarily defined for each of the translational movement and the posture change, the versatility is very wide.
  • the purpose is to lower the expertise of the robot device's hand movement and posture change, and reduce the difficulty of learning the operation.
  • a robot apparatus includes a robot arm mechanism having a plurality of joints that can be equipped with a hand effector at the tip, and an operation unit for an operator to perform an input operation for movement and posture change of the hand effector And a control unit that controls driving of the joint unit according to an input operation via the operation unit, and the operation unit has a posture of the hand effector on a robot coordinate system of the robot arm mechanism.
  • FIG. 1 is an external perspective view of a robot arm mechanism of the robot apparatus according to the present embodiment.
  • FIG. 2 is a side view showing the internal structure of the robot arm mechanism of FIG.
  • FIG. 3 is a diagram showing the configuration of the robot arm mechanism of FIG.
  • FIG. 4 is a block diagram showing the configuration of the robot apparatus according to the present embodiment.
  • FIG. 5 is a plan view showing an operation panel structure of the second arm operation unit of FIG.
  • FIG. 6 is a plan view showing another operation panel structure of the second arm operation unit of FIG.
  • FIG. 7 is a plan view showing another operation panel structure of the second arm operation unit of FIG.
  • FIG. 8 is a plan view showing an operation panel structure of the hand operation unit of FIG.
  • FIG. 1 is an external perspective view of the robot apparatus according to the present embodiment.
  • FIG. 2 is a perspective view showing the internal structure of the robot arm mechanism of FIG.
  • FIG. 3 is a diagram showing the robot arm mechanism of FIG.
  • the robot arm mechanism has a plurality of, here, six joint portions J1, J2, J3, J4, J5, and J6.
  • the plurality of joint portions J1, J2, J3, J4, J5, and J6 are sequentially arranged from the base portion 10.
  • the first, second, and third joint portions J1, J2, and J3 are referred to as the root three axes
  • the fourth, fifth, and sixth joint portions J4, J5, and J6 change the posture of the hand device 3. Called wrist 3 axis.
  • three position degrees of freedom are realized by the first joint portion J1, the second joint portion J2, and the third joint portion J3 that form the three base axes.
  • the wrist 4 has fourth, fifth, and sixth joints J4, J5, and J6.
  • At least one of the joint portions J1, J2, and J3 constituting the base three axes is a linear motion expansion / contraction joint.
  • the third joint portion J3 is configured as a linear motion expansion / contraction joint portion, particularly a joint portion having a relatively long expansion / contraction distance.
  • the arm part 2 represents the expansion / contraction part of the linear motion expansion / contraction joint part J3 (third joint part J3).
  • the first joint portion J1 is a torsion joint centered on the first rotation axis RA1 supported, for example, perpendicularly to the base surface.
  • the second joint portion J2 is a bending joint centered on the second rotation axis RA2 arranged perpendicular to the first rotation axis RA1.
  • the third joint portion J3 is a joint in which the arm portion 2 expands and contracts linearly around a third axis (moving axis) RA3 arranged perpendicular to the second rotation axis RA2.
  • the fourth joint portion J4 is a torsion joint centered on the fourth rotation axis RA4.
  • the fourth rotation axis RA4 substantially coincides with the third movement axis RA3 when a later-described seventh joint portion J7 is not rotating, that is, when the entire arm portion 2 is linear.
  • the fifth joint J5 is a bending joint centered on a fifth rotation axis RA5 orthogonal to the fourth rotation axis RA4.
  • the sixth joint portion J6 is a bending joint centered on the sixth rotation axis RA6 that is perpendicular to the fourth rotation axis RA4 and perpendicular to the fifth rotation axis RA5.
  • the arm support portion (first support portion) 11 constituting the base portion 10 has a cylindrical hollow structure formed around the first rotation axis RA1 of the first joint portion J1.
  • the first joint portion J1 is attached to a fixed base (not shown).
  • the arm portion 2 turns to the left and right as the first support portion 11 rotates.
  • the 1st support part 11 may be fixed to the grounding surface.
  • the arm part 2 is provided in a structure that turns independently of the first support part 11.
  • a second support part 12 is connected to the upper part of the first support part 11.
  • the second support part 12 has a hollow structure that is continuous with the first support part 11.
  • One end of the second support part 12 is attached to the rotating part of the first joint part J1.
  • the other end of the 2nd support part 12 is open
  • the third support portion 13 has a hollow structure composed of a scale-shaped exterior that communicates with the first support portion 11 and the second support portion.
  • the third support part 13 is accommodated in the second support part 12 and sent out as the second joint part J2 is bent and rotated.
  • the rear part of the arm part 2 that constitutes the linearly-extensible and retractable joint part J3 (third joint part J3) of the robot arm mechanism is housed in a continuous hollow structure of the first support part 11 and the second support part 12 by contraction thereof.
  • the third support portion 13 is fitted to the lower end portion of the second support portion 12 so as to be rotatable about the second rotation axis RA2 at the lower end portion of the second support portion 12.
  • a second joint portion J2 as a bending joint portion around the second rotation axis RA2 is configured.
  • the arm portion 2 rotates in a vertical direction around the second rotation axis RA2, that is, performs a undulation operation.
  • the fourth joint portion J4 is a torsional joint having a fourth rotation axis RA4 that is typically in contact with the arm central axis along the expansion / contraction direction of the arm portion 2, that is, the third movement axis RA3 of the third joint portion J3.
  • the fifth joint J5 is a bending joint having a fifth rotation axis RA5 orthogonal to the fourth rotation axis RA4 of the fourth joint J4.
  • the fifth joint portion J5 rotates, it rotates up and down (vertical direction about the fifth rotation axis RA5) together with the hand device 3 from the fifth joint portion J5 to the tip.
  • the sixth joint J6 is a bending joint having a sixth rotation axis RA6 perpendicular to the fourth rotation axis RA4 of the fourth joint J4 and perpendicular to the fifth rotation axis RA5 of the fifth joint J5.
  • the hand device 3 turns left and right.
  • the rotation axis RA1 is arranged perpendicular to the reference plane BP of the base on which the fixed portion of the first joint portion J1 is installed.
  • the 2nd joint part J2 is comprised as a bending joint centering on rotating shaft RA2.
  • the rotation axis RA2 of the second joint J2 is provided in parallel to the Yb axis.
  • the rotation axis RA2 of the second joint portion J2 is provided in a direction perpendicular to the rotation axis RA1 of the first joint portion J1.
  • the second joint portion J2 is offset with respect to the first joint portion J1 in two directions, that is, the direction of the first rotation axis RA1 (Zb axis direction) and the Xb axis direction perpendicular to the first rotation axis RA1.
  • the second support portion 12 is attached to the first support portion 11 so that the second joint portion J2 is offset in the two directions with respect to the first joint portion J1.
  • a virtual arm rod portion (link portion) that connects the second joint portion J2 to the first joint portion J1 has a crank shape in which two hook-shaped bodies whose tips are bent at right angles are combined. This virtual arm rod part is comprised by the 1st, 2nd support parts 11 and 12 which have a hollow structure.
  • 3rd joint part J3 is comprised as a linear motion expansion-contraction joint centering on movement axis RA3.
  • the movement axis RA3 of the third joint portion J3 is provided in a direction perpendicular to the rotation axis RA2 of the second joint portion J2.
  • the movement axis RA3 of the third joint portion J3 is the second joint
  • the rotation axis RA2 of the part J2 and the rotation axis RA1 of the first joint part J1 are provided in a direction perpendicular to the rotation axis RA2.
  • the movement axis RA3 of the third joint portion J3 is provided in parallel to the Xb axis perpendicular to the Yb axis and the Zb axis. Further, the third joint portion J3 is offset with respect to the second joint portion J2 in two directions, that is, the direction of the rotation axis RA2 (Xb axis direction) and the direction of the Zb axis perpendicular to the movement axis RA3.
  • the third support portion 13 is attached to the second support portion 12 so that the third joint portion J3 is offset in the two directions with respect to the second joint portion J2.
  • the virtual arm rod portion (link portion) that connects the third joint portion J3 to the second joint portion J2 has a hook-shaped body whose tip is bent vertically. This virtual arm rod portion is constituted by the second and third support portions 12 and 13.
  • the fourth joint portion J4 is configured as a torsion joint with the rotation axis RA4 as the center.
  • the rotation axis RA4 of the fourth joint part J4 is arranged to substantially coincide with the movement axis RA3 of the third joint part J3.
  • the fifth joint J5 is configured as a bending joint with the rotation axis RA5 as the center.
  • the rotation axis RA5 of the fifth joint portion J5 is disposed so as to be substantially orthogonal to the movement axis RA3 of the third joint portion J3 and the rotation axis RA4 of the fourth joint portion J4.
  • the sixth joint portion J6 is configured as a torsion joint with the rotation axis RA6 as the center.
  • the rotation axis RA6 of the sixth joint portion J6 is disposed so as to be substantially orthogonal to the rotation axis RA4 of the fourth joint portion J4 and the rotation axis RA5 of the fifth joint portion J5.
  • the sixth joint J6 is provided to turn the hand device 3 as a hand effector left and right.
  • the sixth joint portion J6 may be configured as a bending joint whose rotation axis RA6 is substantially orthogonal to the rotation axis RA4 of the fourth joint portion J4 and the rotation axis RA5 of the fifth joint portion J5.
  • one bending joint portion of the base three axes of the plurality of joint portions J1-J6 is replaced with a linear motion expansion / contraction joint portion, and the second joint portion J2 is offset in two directions with respect to the first joint portion J1.
  • the robot arm mechanism of the robot apparatus according to the present embodiment eliminates the singularity posture structurally.
  • the hand device 3 attached to the adapter of the wrist portion 4 includes the first, second, and third joint portions J1. J2. It is moved to an arbitrary position by J3, and is arranged in an arbitrary posture by the fourth, fifth, and sixth joint portions J4, J5, and J6.
  • the length of the extension / contraction distance of the arm portion 2 of the third joint portion J3 enables the hand device 3 to reach a wide range of objects from the proximity position of the base portion 10 to the remote position.
  • the third joint portion J3 is characterized by a linear expansion / contraction operation realized by a linear motion expansion / contraction mechanism constituting the third joint portion J3 and a length of the expansion / contraction distance.
  • the hand device 3 will be described as an example of a structure including a gripping mechanism for picking a workpiece by gripping and a suction mechanism for picking another workpiece by suction.
  • the hand device 3 may be equipped with another structure having other functions.
  • the hand device 3 has a hand body 31.
  • the hand main body 31 has a prismatic shape, and includes an attachment portion on an upper end surface thereof.
  • the hand device 3 is attached to the adapter (joint portion J6) of the wrist portion 4 through the attachment portion.
  • An air chuck box 32 is attached below the hand body 31.
  • the air chuck box 32 has a pair of sliders 33.
  • the pair of sliders 33 are supported so as to be able to approach / separate.
  • the air chuck box 32 has an air cylinder (not shown).
  • a pair of air tubes is connected to the air cylinder. Each of the pair of air tubes is connected to a compression type air pump (not shown).
  • a pair of solenoid valves (not shown) are interposed in the pair of air tubes.
  • the opening / closing solenoid valve driver 301 described later controls the opening / closing of one solenoid valve and the opening / closing of the other solenoid valve in opposite phases.
  • the pair of sliders 33 are moved in the approaching direction.
  • the pair of sliders 33 are moved away from each other.
  • a direction in which the pair of sliders 33 approach / separate is referred to as a slide direction.
  • a pair of grips 34 are attached to the pair of sliders 33.
  • the grip part 34 has a substantially cylindrical shape in appearance.
  • a cylindrical pad (suction pad) 36 is attached to the tip of the grip portion 34.
  • a pair of air tubes is connected to the pair of gripping portions 34. Each of the pair of air tubes is connected to the above-described air pump.
  • a piping path is formed in the grip portion 34 from the connection port with the air tube to the tip thereof. Thereby, a piping path from the air pump to the tip of the grip portion 34 is secured.
  • the air pump may be either a compression type or a vacuum type, but here it will be described as a compression pump.
  • the pad 36 of the grip portion 34 and the air pump are connected by two systems of piping paths, a negative pressure path and a positive pressure path.
  • a negative pressure valve and an ejector are interposed in the negative pressure path.
  • a positive pressure valve is interposed in the positive pressure path.
  • the negative pressure valve and the positive pressure valve are electromagnetic valves. The opening and closing of the negative pressure valve and the opening and closing of the positive pressure valve are controlled in opposite phases by a horizontal adsorption electromagnetic valve driver 302 described later.
  • a negative pressure path is secured.
  • the compressed air generated by the air pump is supplied to the ejector via the negative pressure valve.
  • the ejector has an intake port, a nozzle, and an exhaust port. A rear portion of the pad 36 is connected to the intake port.
  • the compressed air supplied to the ejector is ejected from the nozzle and is discharged from the exhaust port as a bundle of high-speed air. Then, the internal pressure of the chamber of the ejector is lowered, whereby air is sucked from the intake port, and the air sucked from the intake port is exhausted from the exhaust port together with the compressed air.
  • a pair of suction pads 38 are attached to the pair of sliders 33.
  • the suction pad 38 is formed into a cylindrical body with, for example, a silicone resin as an elastic material.
  • the tip surface of the suction pad 38 is referred to as a suction surface that sucks the workpiece.
  • the body portion of the suction pad 38 is formed into a bellows shape.
  • the suction pad 38 sucks the workpiece in the axial direction of the cylindrical body.
  • the suction pad 38 is attached to the slider 33 so that the suction direction is perpendicular to the sliding direction.
  • a pair of air tubes are connected to the pair of suction pads 38. Each of the pair of air tubes is connected to the above-described air pump.
  • the suction pad 38 and the air pump are connected by two systems of piping paths, a negative pressure path and a positive pressure path.
  • a negative pressure valve and an ejector are interposed in the negative pressure path.
  • a positive pressure valve is interposed in the positive pressure path.
  • the negative pressure valve and the positive pressure valve are electromagnetic valves. The opening and closing of the negative pressure valve and the opening and closing of the positive pressure valve are controlled in opposite phases by a solenoid valve driver 303 for vertical adsorption described later.
  • a negative pressure path is secured when the negative pressure valve is open and the positive pressure valve is closed. When the negative pressure path is secured, negative pressure is generated in the suction pad 38.
  • a positive pressure path is secured when the positive pressure valve is open and the negative pressure valve is closed. When the positive pressure path is secured, positive pressure is generated at the suction pad 38.
  • the linear motion expansion / contraction mechanism has an arm portion 2 and an injection portion 42.
  • the arm unit 2 includes a first connection frame row 21 and a second connection frame row 22.
  • the first connected frame row 21 includes a plurality of first connected frames 23.
  • the first connection piece 23 is formed in a substantially flat plate shape.
  • the front and rear first connecting pieces 23 are connected in a row so as to be freely bent by pins at the end portions of each other.
  • column 21 can be bent freely inside and outside.
  • the second linked frame row 22 includes a plurality of second linked frames 24.
  • the second connecting piece 24 is configured as a short groove having a U-shaped cross section.
  • the front and rear second connecting pieces 24 are connected in a row so as to be freely bent by pins at the bottom end portions of each other.
  • the second connecting frame row 22 can be bent inward. Since the cross section of the second connecting piece 24 is U-shaped, the second connecting piece row 22 does not bend outward because the side plates of the adjacent second connecting pieces 24 collide with each other.
  • the surfaces of the first and second connecting pieces 23 and 24 facing the second rotation axis RA2 are referred to as inner surfaces, and the opposite surfaces are referred to as outer surfaces.
  • the first first linked frame 23 in the first linked frame sequence 21 and the first second linked frame 24 in the second linked frame sequence 22 are connected by a linked frame 27.
  • the connecting piece 27 has a shape in which the second connecting piece 24 and the first connecting piece 23 are combined.
  • the injection unit 42 includes a plurality of upper rollers 43 and a plurality of lower rollers 44 supported by a rectangular tube-shaped frame 45.
  • the plurality of upper rollers 43 are arranged along the arm central axis at an interval substantially equal to the length of the first connecting piece 23.
  • the plurality of lower rollers 44 are arranged along the arm central axis at an interval substantially equal to the length of the second connecting piece 24.
  • a guide roller 40 and a drive gear 41 are provided behind the injection unit 42 so as to face each other with the first connecting piece row 21 interposed therebetween.
  • the drive gear 41 is connected to the stepping motor 330 via a speed reducer (not shown).
  • a linear gear is formed on the inner surface of the first connecting piece 23 along the connecting direction.
  • the linear gears are connected in a straight line to form a long linear gear.
  • the drive gear 41 is meshed with a linear linear gear.
  • the linear gear connected in a straight line forms a rack and pinion mechanism together with the drive gear 41.
  • the first connecting piece row 21 is brought into a posture parallel to the arm central axis by the guide roller 40, and the upper roller 43 and the lower roller 44 are Guided in between.
  • the second connecting piece row 22 is guided between the upper roller 43 and the lower roller 44 by a guide rail (not shown) arranged behind the injection portion 42.
  • the first and second connecting frame rows 21 and 22 guided between the upper roller 43 and the lower roller 44 are pressed against each other. Thereby, the columnar body by the 1st, 2nd connection top row
  • the injection unit 42 joins the first and second connecting frame rows 21 and 22 to form a columnar body, and supports the columnar body vertically and horizontally.
  • the columnar body formed by joining the first and second connecting piece rows 21 and 22 is firmly held by the injection portion 42, whereby the joining state of the first and second connecting piece rows 21 and 22 is maintained.
  • the bending of the first and second connection frame rows 21 and 22 is constrained to each other.
  • columns 21 and 22 comprise the columnar body provided with fixed rigidity.
  • the columnar body refers to a columnar rod body in which the first connection frame row 21 is joined to the second connection frame row 22.
  • the second connecting piece 24 and the first connecting piece 23 are formed into cylindrical bodies having various cross-sectional shapes as a whole.
  • the cylindrical body is defined as a shape in which the top, bottom, left, and right sides are surrounded by a top plate, a bottom plate, and both side plates, and a front end portion and a rear end portion are opened.
  • the columnar body formed by joining the first and second connecting piece rows 21 and 22 starts from the connecting piece 27 and linearly extends from the opening of the third support portion 13 along the third movement axis RA3. Sent out.
  • the first connecting piece row 21 engaged with the drive gear 41 is pulled back into the first support portion 11.
  • the columnar body is pulled back into the third support portion 13 along with the movement of the first connection frame row 21.
  • the pulled columnar body is separated behind the injection portion 42.
  • the first connecting piece row 21 constituting the columnar body is sandwiched between the guide roller 40 and the drive gear 41, and the second connecting piece row 22 constituting the columnar body is pulled downward by gravity, and thereby the second connecting piece row is formed.
  • the frame row 22 and the first linked frame row 21 are separated from each other.
  • the separated first and second connecting frame rows 21 and 22 return to a bendable state.
  • the second connecting piece row 22 is bent and conveyed from the injection portion 42 to the storing portion inside the first support portion 11 (base portion 10), and the first connecting piece row 21 is also transported to the second connecting piece. It is bent and conveyed in the same direction (inner side) as the row 22.
  • the first linked frame row 21 is stored in a state substantially parallel to the second linked frame row 22.
  • the world coordinate system ⁇ g is an orthogonal three-axis coordinate system (Xg, Yg, Zg) set on the floor in the factory where the robot device is installed. It is also called an observation coordinate system. Work on it.
  • the user coordinate system ⁇ u is an orthogonal three-axis coordinate system (Xu, Yu, Zu) based on the user who operates the robot apparatus.
  • the robot coordinate system ⁇ b is a coordinate system based on the base 10 of the robot apparatus, and here is an orthogonal three-axis coordinate system with an arbitrary position on the rotation axis RA1 of the first joint portion J1 as the origin.
  • the origin is defined on the ground plane of the base 10 on the rotation axis RA1
  • the Zb axis (vertical axis) is defined on the rotation axis RA1
  • the two axes orthogonal to the Zb axis are defined as the Xb axis and Yb axis.
  • the Xb axis represents the front-rear axis of the robot apparatus
  • the Yb axis represents the left-right axis.
  • the wrist coordinate system ⁇ wr is an orthogonal three-axis coordinate system based on the wrist 4 of the robot apparatus.
  • the wrist reference point set at an arbitrary position on the rotation axis RA4 of the fourth joint portion J4 is used as the origin
  • the rotation axis RA4 of the fourth joint portion J4 is the Xwr axis (front-rear axis)
  • the rotation axis of the fifth joint portion J5 is A Ywr axis (left and right axis) parallel to RA5 and a Zwr axis (vertical axis) perpendicular to these two axes are defined.
  • the wrist posture is the rotation angle around the three orthogonal axes of the wrist coordinate system ⁇ wr, the rotation angle (roll angle) ⁇ wr around the Xwr axis, the rotation angle (pitch angle) ⁇ wr around the Ywr axis, and the rotation angle around the Zwr axis (Yaw angle) is given as ⁇ wr.
  • the hand coordinate system ⁇ h is an orthogonal three-axis coordinate system with the hand device 3 of the robot device as a reference.
  • the center position (referred to as a hand reference point) between the pair of pads 36 of the hand device 3 is the origin, and the sixth joint
  • An Xh axis (front-rear axis) parallel to the turning axis RA6 of the part J6, two axes orthogonal to the Xh axis are defined as a Yh axis, and a Zh axis.
  • the Yh axis indicates the left / right axis of the hand device 3 and the Zh axis indicates the vertical axis of the hand device 3.
  • the hand posture is a rotation angle around each of three orthogonal axes of the hand coordinate system ⁇ h (a rotation angle (roll angle) ⁇ h around the Xh axis, a rotation angle (pitch angle) ⁇ h around the Yh axis, a rotation angle around the Zh axis ( Yaw angle) is given as ⁇ h.
  • the workpiece coordinate system ⁇ wo is an orthogonal three-axis coordinate system based on the workpiece handled by the hand device 3.
  • the Xwo axis front / rear axis
  • the two axes orthogonal to the Xwo axis are Ywo
  • An axis, Zwo axis is defined.
  • the Ywo axis indicates the left and right axis of the workpiece
  • the Zwo axis indicates the vertical axis of the workpiece.
  • the workpiece posture is a rotation angle around each of three orthogonal axes of the workpiece coordinate system ⁇ wo (a rotation angle (roll angle) ⁇ wo around the Xwo axis, a rotation angle (pitch angle) ⁇ wo around the Ywo axis, a rotation angle around the Zwo axis ( Yaw angle) is given as ⁇ wo.
  • FIG. 4 is a block diagram showing the configuration of the robot apparatus according to this embodiment.
  • the robot apparatus includes an articulated arm mechanism 200 and a hand apparatus 3. Under the control of the motion control device 100, the joint portion J3 constituting the multi-joint arm mechanism 200 expands and contracts, the joint portions J1, J2, J4-J6 are rotated, and the hand device 3 is operated.
  • the multi-joint arm mechanism 200 has a plurality of joint portions J1, J2, J3, J4, J5, and J6.
  • a stepping motor is provided in each of the plurality of joint portions J1-J6.
  • the rotation of these stepping motors is controlled by the driver unit 201.
  • the driver unit 201 sends a pulse signal corresponding to the position command value from the operation control device 100 to the stepping motor.
  • the stepping motor rotates to a position corresponding to the command value.
  • a rotary encoder 202 that outputs a pulse at every predetermined rotation angle is connected to the drive shaft of these stepping motors.
  • the encode pulse output from the rotary encoder 202 is added / subtracted by a counter (not shown) of the driver unit 201.
  • the count value of the encode pulse counted by the counter is input to the operation control apparatus 100 via the driver unit interface 105.
  • the hand device 3 includes a solenoid valve driver 301 for opening and closing, a solenoid valve driver 302 for horizontal suction, and a solenoid valve driver 303 for vertical suction.
  • the opening / closing solenoid valve driver 301 opens and closes the solenoid valve of the air chuck structure 32 in accordance with an opening / closing command for the gripping section 34 input via the hand operation section 70 described later.
  • the electromagnetic valve driver 302 for horizontal suction uses a positive pressure valve interposed between the pad 36 of the grip portion 34 and the air pump in accordance with the ON command for the suction operation of the pad 36 input via the hand operation unit 70 described later.
  • the negative pressure valve is closed and opened at an opening corresponding to the suction strength set by the operator using the hand operation unit 70.
  • the electromagnetic valve driver 302 for horizontal adsorption uses a positive pressure valve interposed between the pad 36 of the grip portion 34 and the air pump in accordance with an OFF command for the adsorption operation of the pad 36 input via the hand operation unit 70 described later. Open and close the negative pressure valve.
  • the electromagnetic valve driver 303 for vertical suction closes the positive pressure valve interposed between the suction pad 38 and the air pump in accordance with the ON command for suction operation of the suction pad 38 input via the hand operation unit 70 described later,
  • the negative pressure valve is opened at an opening corresponding to the suction strength set by the operator using the hand operation unit 70.
  • the electromagnetic valve driver 303 for vertical suction opens a positive pressure valve interposed between the suction pad 38 and the air pump in accordance with an OFF command for suction operation of the suction pad 38 input via the hand operation unit 70 described later. Close the negative pressure valve.
  • the operation control apparatus 100 is configured such that each unit is connected through a control / data bus 109 with the system control unit 101 as a center.
  • the motion control device 100 includes two arm operation units 50 and 60 for the operator to manually change the position and orientation of the point of interest of the robot device, and the first arm operation unit interface 102 and the second arm, respectively.
  • the operation unit interface 103 is connected.
  • a hand operation unit 70 for an operator to operate the operation of the hand device 3 is connected to the operation control device 100 via a hand operation unit interface 104.
  • the motion control unit 106 determines the position of each joint J1-J6 for each control period ⁇ t according to the movement instruction and rotation instruction of the robot apparatus input by the user via the first arm operation unit 50 or the second arm operation unit 60. Generates a command value.
  • the position command value generated by the motion control unit 106 is transmitted via the driver unit I / F 105 to the driver units 201 of the joint portions J1-J6 every control period ⁇ t.
  • the robot coordinate system ⁇ b is the reference coordinate system
  • the hand coordinate system ⁇ h is the target coordinate system.
  • the operation control unit 106 calculates joint variables ( ⁇ 1, ⁇ 2, d3, ⁇ 4, ⁇ 5, ⁇ 6) of the joints J1, J2, J3, J4, J5, and J6 based on the output pulse of the encoder 202.
  • the joint variable refers to six variables including the joint angle of the joint portions J1, J2, J4, J5, and J6 and the extension distance of the joint portion J3.
  • the motion control unit 106 When the translation movement is instructed by the first arm operation unit 50 or the second arm operation unit 60, the motion control unit 106 is based on the current position of the hand reference point and the final target position input by these arm operation units. Thus, the target position for each control cycle ⁇ t is calculated by a preset trajectory calculation formula.
  • the motion control unit 106 calculates joint variables ( ⁇ 1, ⁇ 2, d3, ⁇ 4, ⁇ 5, ⁇ 6) for moving the hand reference point from the current position to the target position while maintaining the hand posture at the start of translational movement. Then, a position command value corresponding to the calculated joint variable is generated.
  • the operation control unit 106 is based on the current hand posture and the final target posture input by these arm operation units.
  • the target posture for each control period ⁇ t is calculated from the rotation matrix related to the Xh axis, Yh axis, and Zh axis of the hand coordinate system ⁇ h.
  • the motion control unit 106 maintains the position of the hand reference point at the start of translational movement, and the joint variables ( ⁇ 1, ⁇ 2, d3, ⁇ 4, ⁇ 5, ⁇ 6) for changing from the current hand posture to the target posture. And a position command value corresponding to the calculated joint variable is generated.
  • the motion control unit 106 If another coordinate system (world coordinate system / user coordinate system) is selected as the reference coordinate system, or another coordinate system (wrist coordinate system / work coordinate system), reference coordinate system and target coordinate system are selected as the target coordinate system. Even when both the system and the other coordinate system are selected, the motion control unit 106 generates a position command value for each control cycle ⁇ t based on the inputs of the arm operation units 50 and 60 as described above. To do. For this purpose, the motion control unit 106 defines a plurality of identical coordinates that define the relationship between the reference coordinate system (world coordinate system / user coordinate system / robot coordinate system) and the target coordinate system (wrist coordinate system / hand coordinate system / work coordinate system).
  • the robot apparatus includes two arm operation units 50 and 60 for operating the robot arm mechanism.
  • the first arm operation unit 50 is highly versatile and suitable for use mainly by specialists who need specialized knowledge covering all or most of the moving and rotating operations that can be provided by the robot apparatus according to the present embodiment. It is an operation unit.
  • the second arm operation unit 60 is limited to some movement rotation operations among the movement rotation operations that can be provided by the robot apparatus according to the present embodiment, and is general-purpose by fixing the relationship between these movements and operation buttons. It is an operation unit that can be expected to have high operational proficiency although its performance is low. For example, an operator skilled in the operation of the robot arm mechanism can efficiently operate the robot arm mechanism while switching between the reference coordinate system and the target coordinate system using the first arm operation unit 50. It has become. A person with a low level of proficiency who is unfamiliar with the operation of the robot arm mechanism can easily operate the robot arm mechanism using the second arm operation unit 60.
  • the first arm operation unit 50 is equipped with a plurality of buttons for covering the moving and rotating operations that can be provided by the robot apparatus according to the present embodiment.
  • the robot apparatus according to the present embodiment provides the following movement and rotation operations.
  • Translational movement is a movement in which the relative position of the origin of the target coordinate system with respect to the reference coordinate system changes continuously while maintaining the angle difference (attitude) of each axis of the target coordinate system on the reference coordinate system.
  • the origin of the target coordinate system is limited to a movement in which the coordinates of one axis of the reference coordinate system change.
  • the reference coordinate system one of the world coordinate system ⁇ g, the user coordinate system ⁇ u, and the robot coordinate system ⁇ b is selected by the user.
  • one of the wrist coordinate system ⁇ wr, the hand coordinate system ⁇ h, and the work coordinate system ⁇ wo is selected by the user.
  • the robot coordinate system ⁇ b is selected as the reference coordinate system
  • the hand coordinate system ⁇ h is selected as the target coordinate system.
  • the hand moves along each of the three orthogonal axes of the robot coordinate system ⁇ b while maintaining the hand posture on the robot coordinate system ⁇ b at the start of the translation movement operation. Is done.
  • the wrist coordinate system ⁇ wr is selected as the target coordinate system
  • the wrist is moved along any one of the three orthogonal axes of the reference coordinate system while maintaining the wrist posture on the reference coordinate system. .
  • the translational movement mixing operation refers to a movement in which one of the three orthogonal axes on the reference coordinate system is translated into one or two other axes.
  • Wrist posture change Changing the wrist posture means that the origin of the wrist coordinate system ⁇ wr is fixed on the reference coordinate system, the wrist coordinate system ⁇ wr rotates around its Xwr axis on the reference coordinate system (roll ⁇ wr), and around the Ywr axis And the wrist posture is changed by rotating around the Zwr axis (yaw ⁇ wr).
  • the posture change focusing on the wrist is performed when the wrist coordinate system ⁇ wr is selected as the target coordinate system.
  • Changing the hand posture means that the origin of the hand coordinate system ⁇ h is fixed on the reference coordinate system, the hand coordinate system ⁇ h rotates around the Xh axis on the reference coordinate system (roll ⁇ h), and around the Yh axis And the hand posture is changed by rotating around the Zh axis (yaw ⁇ h).
  • the posture change focusing on the hand is performed when the hand coordinate system ⁇ h is selected as the target coordinate system.
  • the work posture change means that the origin of the workpiece coordinate system ⁇ wo is fixed on the reference coordinate system, the workpiece coordinate system ⁇ wo rotates around its Xwo axis on the reference coordinate system (roll ⁇ wo), and around the Ywo axis And the workpiece posture is changed by rotating around the Zh axis (yaw ⁇ wo).
  • the posture change focusing on the workpiece is performed when the workpiece coordinate system ⁇ wo is selected as the target coordinate system.
  • Rotation operation for each rotation axis refers to an operation in which the plurality of joint portions J1-J6 rotate independently around the rotation axes RA1-RA6 independently of the reference coordinate system and the target coordinate system.
  • the first arm operation unit 50 is equipped with operation buttons for the user to input these various operations.
  • the first arm operation unit 50 includes buttons for allowing the user to arbitrarily set one coordinate system of the world coordinate system ⁇ g, the user coordinate system ⁇ u, and the robot coordinate system ⁇ b as a reference coordinate system for translation.
  • a button for the user to arbitrarily set one of the wrist coordinate system ⁇ wr, the hand coordinate system ⁇ h, and the work coordinate system ⁇ wo is provided as the target coordinate system.
  • the first arm operation unit 50 is provided with a button for the user to arbitrarily set one of the wrist coordinate system ⁇ wr, the hand coordinate system ⁇ h, and the work coordinate system ⁇ wo as a target coordinate system for posture change.
  • the first arm operation unit 50 is equipped with six operation buttons for inputting and operating the translation of the target point (origin) of the selected target coordinate system.
  • the six operation buttons for inputting the translational movement are individually associated with one of the three orthogonal axes of the reference coordinate system with respect to the movement axis and one of the positive and negative of each axis with respect to the movement direction.
  • the first arm operation unit 50 is equipped with six operation buttons for input operation of posture change.
  • the six operation buttons for inputting the posture change are individually associated with one of the three orthogonal axes of the target coordinate system with respect to the rotation axis and one of the positive and negative of each axis with respect to the rotation direction.
  • the first arm operation unit 50 is equipped with 12 operation buttons for individually rotating the joint portions J1-J6 positively and negatively.
  • a plurality of adjustment buttons for adjusting the movement speed (rotation speed) may be provided. These buttons may be configured by mounting physical buttons, may be configured by a display equipped with a touch panel, or may be configured by a combination thereof.
  • the second arm operation unit 60 is formed in a weight and size that can be held with one hand, and has a rectangular plane shape on an operation panel that allows the user to perform limited movement rotation operations among the movement rotation operations of the robot apparatus. Is equipped with operation buttons for input operation.
  • the second arm operation unit 60 is an input operation limited to the translational movement (2) and the change of the hand posture (4) among the movement and rotation operations (above (1) to (6)) that the robot apparatus can provide.
  • buttons for are limitedly equipped.
  • the robot coordinate system ⁇ b is fixed as the reference coordinate system
  • the hand coordinate system ⁇ h is fixed as the target coordinate system.
  • the target coordinate system is fixed to the same hand coordinate system ⁇ h as the translational movement.
  • FIG. 5 is a plan view showing an operation panel structure of the second arm operation unit 60 of FIG.
  • the second arm operation unit 60 includes a first operation button set (601-606) for translating the hand on the robot coordinate system ⁇ b and a second operation button set (611-616) for changing the hand posture. And are equipped.
  • the first operation button set is composed of six physical push buttons 601-606 for inputting and operating positive and negative movements about each of three orthogonal axes of the robot coordinate system ⁇ b.
  • the corresponding moving direction is indicated by characters (up, down, front, back, left, right).
  • the second operation button set includes six physical push buttons 611 to 616 for performing input operation on positive and negative rotations about three orthogonal axes of the hand coordinate system ⁇ h.
  • Each of these six push buttons has a corresponding axis and a rotation direction around the axis indicated by a symbol.
  • the six push buttons 601-606 of the first operation button set are arranged on the upper part of the second arm operation unit 60.
  • two push buttons 601 and 602 related to the back-and-forth movement on the robot coordinate system ⁇ b are juxtaposed in the longitudinal direction (vertical direction) of the operation panel.
  • Two push buttons 603 and 604 related to the left / right movement are juxtaposed in the short direction (width direction and lateral direction) of the operation panel. That is, four push buttons 601-604 related to the front / rear / left / right movement on the robot coordinate system ⁇ b are arranged in a cross shape.
  • two push buttons 605 and 606 related to the vertical movement on the robot coordinate system ⁇ b are juxtaposed in the vertical direction in a region adjacent to the right of the four push buttons 601 to 604.
  • the push buttons 601 and 602 correspond to the positive and negative directions of the Xh axis of the robot coordinate system ⁇ b, respectively.
  • the push buttons 603 and 604 correspond to the positive and negative directions of the Yh axis of the robot coordinate system ⁇ b, respectively.
  • the push buttons 605 and 606 correspond to the positive and negative directions of the Zh axis of the robot coordinate system ⁇ b, respectively.
  • the push button 601 has a character “Previous” indicating the moving direction.
  • the hand device 3 While the push button 601 is being pressed, the hand device 3 is translated at a predetermined speed in the positive direction of the Xh axis on the robot coordinate system ⁇ b while maintaining the posture of the hand device 3. On the push button 602, a character “rear” indicating the moving direction is written. While the push button 602 is pressed, the hand device 3 is translated at a predetermined speed in the negative direction of the Xh axis on the robot coordinate system ⁇ b while maintaining the posture of the hand device 3.
  • the six push buttons 611-616 of the second operation button set are arranged below the second arm operation unit 60 and below the first operation button set.
  • Six push buttons 611-616 of the second operation button set are distributed in the width direction of the second arm operation unit 60, two for each of three orthogonal axes of the hand coordinate system ⁇ h.
  • Two push buttons provided for each of the three orthogonal axes are arranged in the vertical direction of the second arm operation unit 60.
  • a pattern 617-619 indicating the position of the corresponding rotation axis is shown below the two push buttons provided for each of the three orthogonal axes.
  • the operation buttons 611 and 612 correspond to (+) / ( ⁇ ) rotation (roll ⁇ h) around the Xh axis.
  • the operation buttons 613 and 614 correspond to (+) / ( ⁇ ) rotation (pitch ⁇ h) around the Yh axis.
  • the operation buttons 615 and 616 correspond to (+) / ( ⁇ ) rotation (yaw ⁇ h) around the Zh axis of the hand coordinate system ⁇ h. For example, while the push button 611 is being pressed, the hand device 3 is rotated around the Xh axis indicated on the symbol 617 in the direction indicated on the push button 611 at a predetermined speed.
  • a power button 621 for activating the second arm operation unit 60, an emergency stop button 620 for invalidating the operation of the second arm operation unit 60, and the second arm operation unit 60 Is provided with an indicator lamp 623 for notifying the operator whether or not the computer is activated and an indicator lamp 624 for notifying the operator whether or not the operation button is pressed.
  • FIG. 6 is a plan view showing another operation panel structure of the second arm operation unit 60 of FIG.
  • six push buttons 601-606 constituting the first operation button set are arranged on the upper part of the second arm operation unit 60.
  • six push buttons 611-616 constituting the second operation button set are arranged below the first operation button set.
  • a symbol 630 indicating the orientation of each of the three orthogonal axes of the hand coordinate system ⁇ h is written below the second operation button set.
  • this symbol 630 represents the outline of the object of movement, here the hand of the robot apparatus.
  • Each of the three orthogonal axes represented by the symbol 630 is associated with two push buttons provided for each axis by a lead line.
  • a power button 621, an emergency stop button 620, and indicator lamps 623 and 624 are disposed below the symbol 630 indicating the directions of the three orthogonal axes of the hand coordinate system ⁇ h.
  • the operator can more easily understand the positional relationship of each axis, so that the ease of operation of the rotation operation is improved. Improvement is realized.
  • FIG. 7 is a plan view showing another operation panel structure of the second arm operation unit 60 of FIG.
  • the second arm operation unit 60 includes the translational movement (2) and the rotational movement for each rotational axis (6) among the rotational movements (above (1) to (6)) that can be provided by the robot apparatus. It is equipped with multiple buttons for the operator to input only.
  • the reference coordinate system is fixed to the robot coordinate system ⁇ b
  • the target coordinate system is fixed to the hand coordinate system ⁇ h.
  • the second arm operation unit 60 is equipped with a first operation button set for translating the hand on the robot coordinate system ⁇ b and a second operation button set for directly rotating each of the three wrist axes. .
  • a first operation button set for translating the hand on the robot coordinate system ⁇ b
  • a second operation button set for directly rotating each of the three wrist axes.
  • six push buttons 601-606 constituting the first operation button set are arranged on the upper part of the second arm operation unit 60.
  • a second operation button set is disposed below the first operation button set.
  • a power button 621, an emergency stop button 620, and indicator lamps 623 and 624 are disposed below the second operation button set.
  • the second operation button set is composed of six physical push buttons 641 to 646 for inputting a positive / negative rotation for each of the three wrist axes.
  • Each of these six push buttons 641 to 646 has a corresponding axis and a rotation direction around the axis indicated by symbols.
  • the six push buttons 641-646 are distributed in the width direction of the second arm operation unit 60, two for each of the three wrist axes. Two push buttons provided for each of the three wrist axes are distributed in the vertical direction of the second arm operation unit 60. Below the two push buttons provided for each of the three wrist axes, a symbol 647-649 indicating the position of the corresponding rotating shaft is displayed.
  • the operation buttons 641 and 642 correspond to (+) / ( ⁇ ) rotation around the rotation axis RA4 of the fourth joint portion J4.
  • the operation buttons 643 and 644 correspond to (+) / ( ⁇ ) rotation around the rotation axis RA5 of the fifth joint portion J5.
  • the operation buttons 645 and 646 correspond to (+) / ( ⁇ ) rotation around the rotation axis RA6 of the sixth joint portion J6.
  • FIG. 8 is a plan view showing an operation panel structure of the hand operation unit 70 of FIG.
  • a plurality of operation buttons 701 and 702 for opening and closing the pair of gripping units 34 of the hand device 3 are arranged in the upper part of the hand operation unit 70 in a distributed manner in the width direction of the hand operation unit 70.
  • opening / closing is indicated by characters.
  • a plurality of operation buttons 711 and 712 for turning ON / OFF the suction operation of the pad 36 of the grip portion 34 are arranged in the width direction of the hand operation unit 70. Yes.
  • On these operation buttons 711 and 712, “ON” and “OFF” are written in letters, respectively.
  • a plurality of selection buttons 713, 714, 715 are arranged for the operator to arbitrarily select the suction force of the suction operation of the pad 36 of the grip portion 34.
  • the plurality of selection buttons 713, 714, 715 are distributed in the width direction of the hand operation unit 70.
  • the plurality of selection buttons 713, 714, and 715 have characters (“strong”, “medium”, and “weak”) representing the strength of the attractive force, respectively.
  • a plurality of operation buttons 721, 722 for turning ON / OFF the suction operation of the suction pad 38 are arranged in the width direction of the hand operation unit 70.
  • buttons 721 and 722 “ON” and “OFF” are written in characters, respectively.
  • a plurality of selection buttons 723, 724, and 725 for the operator to arbitrarily select the suction force of the suction operation of the suction pad 38 are arranged.
  • the plurality of selection buttons 723, 724, and 725 are distributed in the width direction of the hand operation unit 70.
  • characters (“strong”, “medium”, and “weak”) indicating the strength of the attractive force are respectively written.
  • a power button 731 for activating the hand operation unit 70, an emergency stop button 730 for invalidating the operation of the hand operation unit 70, and whether the hand operation unit 70 is activated An indicator lamp 733 for notifying the operator of whether or not, and an indicator lamp 734 for notifying the operator of whether or not the operation button is pressed are provided.
  • the second arm operation unit 60 limited to the input operation of the limited operation selected from the movement and rotation operations related to the arm mechanism of the robot apparatus is replaced with the first arm operation unit 50 covering all the input operations of the operation.
  • the operator can selectively use the operation unit according to his / her level of operation proficiency.
  • the reference coordinate system and target coordinate system for translation are set to the robot coordinate system and the hand coordinate system, and these are fixed to the operation buttons. Is set to the same hand coordinate system as the target coordinate system for translation, so the direction of these coordinate systems is very easy to understand from the shape of the arm mechanism and hand part, etc., and the arm mechanism and hand part can be viewed vertically and horizontally However, it is possible to perform an input operation accordingly, and it can be said that the motion predictability is higher than other coordinate systems, and the operation can be improved in a short period of time.
  • the second arm operation unit 60 is equipped with an independent physical push button for each target motion, so that it is possible to avoid simultaneous input operations by mixing two or more motions due to its structure. It is possible to eliminate the inconvenience caused by an unexpected operation different from the intended operation. This can be further improved by expressing the corresponding movement direction for each of the six push buttons for translation by letters and the corresponding rotation direction for each of the six push buttons for posture change by symbols. .
  • buttons related to translational movement are arranged separately on the upper part of the operation unit, six push buttons related to posture change are separately arranged on the lower part of the operation part, and six push buttons related to translational movement are arranged.
  • 4 push buttons related to forward / backward / left / right movement are arranged in a cross, 2 push buttons related to up / down movement are arranged next to 4 push buttons, and 6 push buttons related to posture change are further arranged.
  • a button arrangement makes it easy to identify the buttons by touching the fingertips without visually recognizing the operation panel, and moving the viewpoint from the arm mechanism and the hand unit. Realize accurate input operation.

Abstract

目的は、ロボット装置の手先移動、姿勢変更の操作専門性を下げ、操作習得の難度を抑制させること。 ロボット装置は、手先効果器(3)を装備可能なロボットアーム機構と、手先効果器の移動及び姿勢変更について操作者が入力操作するための操作部(60)と、操作部を介した入力操作に従ってロボットアーム機構の駆動を制御する制御部(101)とを具備し、操作部にはロボット座標系上での手先効果器の姿勢が固定された状態で手先効果器がロボット座標系の直交3軸の各軸に沿って正負に移動する並進移動に関する第1操作ボタンセットと、ロボット座標系上での手先効果器の手先座標系の原点位置が固定した状態で手先座標系の直交3軸の各軸を回転中心として手先効果器が正負に回転する姿勢変更動作に関する第2操作ボタンセットとがロボットアーム機構の移動回転に係る動作入力操作手段として限定的に装備されていることを特徴とする。

Description

ロボット装置
 本発明の実施形態はロボット装置に関する。
 近年ロボットがユーザと同一空間にいる環境が多くなってきている。介護用ロボットはもちろん産業用ロボットでも作業者と並んで作業を行なう状況が今後拡大していくものと考えられる。あるロボット装置は垂直多関節部アーム機構を備えている。垂直多関節部アーム機構は一般的には根元3軸と呼ばれる関節部J1,J2,J3と手首3軸と呼ばれる関節部J4,J5,J6とを装備している。例えばダイレクトティーチング工程において、これら6個の関節部J1-J6を個別に又は連動動作させることにより、手先を移動させ、手先姿勢を任意に変更している。
 最も簡易には根元関節部J1,J2,J3の個別駆動により手先が移動し、手首関節部J4,J5,J6の個別駆動により手先姿勢が変更される。これら関節部の連動制御により手先姿勢を固定した状態での移動(並進移動)や手先位置を固定した状態での手先姿勢を変更することが可能となる。並進移動、姿勢変更の操作についてユーザはワールド座標系、ロボット座標系、ユーザ座標系のいずれかを基準座標系として選択し、手首座標系、手先座標系(ツール座標系)、ワーク座標系のいずれかを対象座標系として選択して操作空間をロボット装置の適用環境に応じて好適に定義することができる。並進移動では、基準座標系に対する対象座標系の原点が変位され、基準座標系に対する対象座標系の相対的角度が固定される。姿勢変更では、基準座標系上での対象座標系の原点を固定したまま対象座標系がその直交3軸の各軸を中心として回転される。並進移動、姿勢変更それぞれについて基準座標系と対象座標系を任意に定義できるので、汎用性は非常に広い。
 その一方でこれら座標系の組み合わせは膨大に存在し、それら組み合わせにより実際にどのように移動し姿勢が変更されるのかが変化する。この移動や姿勢変更について座標系の膨大な組み合わせごとに理解することは非常に専門性が高く、それを習得するには困難を伴っていた。
 目的は、ロボット装置の手先移動、姿勢変更の操作専門性を下げ、操作習得の難度を抑制させることにある。
 本実施形態にかかるロボット装置は、先端に手先効果器を装備可能な複数の関節部を有するロボットアーム機構と、前記手先効果器の移動及び姿勢変更について操作者が入力操作をするための操作部と、前記操作部を介した入力操作に従って前記関節部の駆動を制御する制御部とを具備し、前記操作部には、前記ロボットアーム機構のロボット座標系上での前記手先効果器の姿勢が固定された状態で前記手先効果器が前記ロボット座標系の直交3軸の各軸に沿って正負に移動する並進移動に関する第1操作ボタンセットと、前記ロボット座標系上での前記手先効果器の手先座標系の原点位置が固定した状態で前記手先座標系の直交3軸の各軸を回転中心として前記手先効果器が正負に回転する姿勢変更動作に関する第2操作ボタンセットとが前記ロボットアーム機構の移動回転に係る動作入力操作手段として限定的に装備されていることを特徴とする。
図1は、本実施形態に係るロボット装置のロボットアーム機構の外観斜視図である。 図2は、図1のロボットアーム機構の内部構造を示す側面図である。 図3は、図1のロボットアーム機構の構成を図記号表現により示す図である。 図4は、本実施形態によるロボット装置の構成を示すブロック図である。 図5は、図4の第2アーム操作部の操作パネル構造を示す平面図である。 図6は、図4の第2アーム操作部の他の操作パネル構造を示す平面図である。 図7は、図4の第2アーム操作部の他の操作パネル構造を示す平面図である。 図8は、図4のハンド操作部の操作パネル構造を示す平面図である。
 以下、図面を参照しながら本実施形態に係るロボット装置を説明する。以下の説明において、略同一の機能及び構成を有する構成要素については、同一符号を付し、重複説明は必要な場合にのみ行う。
 図1は、本実施形態に係るロボット装置の外観斜視図である。図2は、図1のロボットアーム機構の内部構造を示す斜視図である。図3は、図1のロボットアーム機構を図記号表現により示す図である。
 ロボットアーム機構は、複数、ここでは6つの関節部J1,J2,J3,J4,J5,J6を有する。複数の関節部J1,J2,J3,J4,J5,J6は基部10から順番に配設される。一般的に、第1、第2、第3関節部J1,J2,J3は根元3軸と呼ばれ、第4、第5、第6関節部J4,J5,J6はハンド装置3の姿勢を変化させる手首3軸と呼ばれる。ロボットアーム機構において、根元3軸を構成する第1関節部J1と第2関節部J2と第3関節部J3とにより3つの位置自由度が実現される。また、手首3軸を構成する第4関節部J4と第5関節部J5と第6関節部J6とにより3つの姿勢自由度が実現される。手首部4は第4、第5、第6関節部J4,J5,J6を有する。根元3軸を構成する関節部J1,J2,J3の少なくとも一つは直動伸縮関節である。ここでは第3関節部J3が直動伸縮関節部、特に伸縮距離の比較的長い関節部として構成される。アーム部2は直動伸縮関節部J3(第3関節部J3)の伸縮部分を表している。
 第1関節部J1は基台面に対して例えば垂直に支持される第1回転軸RA1を中心としたねじり関節である。第2関節部J2は第1回転軸RA1に対して垂直に配置される第2回転軸RA2を中心とした曲げ関節である。第3関節部J3は、第2回転軸RA2に対して垂直に配置される第3軸(移動軸)RA3を中心として直線的にアーム部2が伸縮する関節である。
 第4関節部J4は、第4回転軸RA4を中心としたねじり関節である。第4回転軸RA4は、後述の第7関節部J7が回転していないとき、つまりアーム部2の全体が直線形状にあるとき、第3移動軸RA3と略一致する。第5関節部J5は第4回転軸RA4に対して直交する第5回転軸RA5を中心とした曲げ関節である。第6関節部J6は第4回転軸RA4に対して直交し、第5回転軸RA5に対して垂直に配置される第6回転軸RA6を中心とした曲げ関節である。
 基部10を成すアーム支持部(第1支持部)11は、第1関節部J1の第1回転軸RA1を中心に形成される円筒形状の中空構造を有する。第1関節部J1は図示しない固定台に取り付けられる。第1関節部J1が回転するとき、アーム部2は第1支持部11の軸回転とともに左右に旋回する。なお、第1支持部11が接地面に固定されていてもよい。その場合、第1支持部11とは独立してアーム部2が旋回する構造に設けられる。第1支持部11の上部には第2支持部12が接続される。
 第2支持部12は第1支持部11に連続する中空構造を有する。第2支持部12の一端は第1関節部J1の回転部に取り付けられる。第2支持部12の他端は開放され、第3支持部13が第2関節部J2の第2回転軸RA2において回動自在に嵌め込まれる。第3支持部13は第1支持部11及び第2支持部に連通する鱗状の外装からなる中空構造を有する。第3支持部13は、第2関節部J2の曲げ回転に伴ってその後部が第2支持部12に収容され、また送出される。ロボットアーム機構の直動伸縮関節部J3(第3関節部J3)を構成するアーム部2の後部はその収縮により第1支持部11と第2支持部12の連続する中空構造の内部に収納される。
 第3支持部13はその後端下部において第2支持部12の開放端下部に対して第2回転軸RA2を中心として回動自在に嵌め込まれる。それにより第2回転軸RA2を中心とした曲げ関節部としての第2関節部J2が構成される。第2関節部J2が回動するとき、アーム部2は第2回転軸RA2を中心に垂直方向に回動、つまり起伏動作をする。
 第4関節部J4は、アーム部2の伸縮方向に沿ったアーム中心軸、つまり第3関節部J3の第3移動軸RA3に典型的には接する第4回転軸RA4を有するねじり関節である。第4関節部J4が回転すると、手首部4及び手首部4に取り付けられたハンド装置3は第4回転軸RA4を中心に回転する。第5関節部J5は、第4関節部J4の第4回転軸RA4に対して直交する第5回転軸RA5を有する曲げ関節部である。第5関節部J5が回転すると、第5関節部J5から先端にかけてハンド装置3とともに上下(第5回転軸RA5を中心に垂直方向)に回動する。第6関節部J6は、第4関節部J4の第4回転軸RA4に直交し、第5関節部J5の第5回転軸RA5に垂直な第6回転軸RA6を有する曲げ関節である。第6関節部J6が回転すると、ハンド装置3は左右に旋回する。
 図3に示すように回転軸RA1は第1関節部J1の固定部が設置される基台の基準面BPに垂直に配置される。第2関節部J2は回転軸RA2を中心とした曲げ関節として構成される。第2関節部J2の回転軸RA2はYb軸に平行に設けられる。第2関節部J2の回転軸RA2は第1関節部J1の回転軸RA1に対して垂直な向きに設けられる。さらに第2関節部J2は、第1関節部J1に対して、第1回転軸RA1の方向(Zb軸方向)と第1回転軸RA1に垂直なXb軸方向との2方向に関してオフセットされる。第2関節部J2が第1関節部J1に対して上記2方向にオフセットされるように、第2支持部12は第1支持部11に取り付けられる。第1関節部J1に第2関節部J2を接続する仮想的なアームロッド部分(リンク部分)は、先端が直角に曲がった2つの鈎形状体が組み合わされたクランク形状を有している。この仮想的なアームロッド部分は、中空構造を有する第1、第2支持部11、12により構成される。
 第3関節部J3は移動軸RA3を中心とした直動伸縮関節として構成される。第3関節部J3の移動軸RA3は第2関節部J2の回転軸RA2に対して垂直な向きに設けられる。第2関節部J2の回転角がゼロ度、つまりアーム部2の起伏角がゼロ度であってアーム部2が水平な基準姿勢においては、第3関節部J3の移動軸RA3は、第2関節部J2の回転軸RA2とともに第1関節部J1の回転軸RA1にも垂直な方向に設けられる。空間座標系上では、第3関節部J3の移動軸RA3はYb軸及びZb軸に対して垂直なXb軸に平行に設けられる。さらに、第3関節部J3は、第2関節部J2に対して、その回転軸RA2の方向(Xb軸方向)と、移動軸RA3に直交するZb軸の方向との2方向に関してオフセットされる。第3関節部J3が第2関節部J2に対して上記2方向にオフセットされるように、第3支持部13は第2支持部12に取り付けられる。第2関節部J2に第3関節部J3を接続する仮想的なアームロッド部分(リンク部分)は、先端が垂直に曲がった鈎形状体を有している。この仮想的なアームロッド部分は、第2、第3支持部12、13により構成される。
 第4関節部J4は回転軸RA4を中心としたねじり関節として構成される。第4関節部J4の回転軸RA4は第3関節部J3の移動軸RA3に略一致するよう配置される。第5関節部J5は回転軸RA5を中心とした曲げ関節として構成される。第5関節部J5の回転軸RA5は第3関節部J3の移動軸RA3及び第4関節部J4の回転軸RA4に略直交するよう配置される。第6関節部J6は回転軸RA6を中心としたねじり関節として構成される。第6関節部J6の回転軸RA6は第4関節部J4の回転軸RA4及び第5関節部J5の回転軸RA5に略直交するよう配置される。第6関節部J6は手先効果器としてのハンド装置3を左右に旋回するために設けられている。なお、第6関節部J6は、その回転軸RA6が第4関節部J4の回転軸RA4及び第5関節部J5の回転軸RA5に略直交する曲げ関節として構成されてもよい。
 このように複数の関節部J1-J6の根元3軸のうちの一つの曲げ関節部を直動伸縮関節部に換装し、第1関節部J1に対して第2関節部J2を2方向にオフセットさせ、第2関節部J2に対して第3関節部J3を2方向にオフセットさせることにより、本実施形態に係るロボット装置のロボットアーム機構は、特異点姿勢を構造上解消している。
 上記の通り手首部4のアダプタに取り付けられたハンド装置3は、第1、第2、第3関節部J1.J2.J3により任意位置に移動され、第4、第5、第6関節部J4、J5、J6により任意姿勢に配置される。特に第3関節部J3のアーム部2の伸縮距離の長さは、基部10の近接位置から遠隔位置までの広範囲の対象にハンド装置3を到達させることを可能にする。第3関節部J3はそれを構成する直動伸縮機構により実現される直線的な伸縮動作とその伸縮距離の長さとが特徴的である。
 ハンド装置3は、ワークを把持によりピッキングするための把持機構と他のワークを吸着によりピッキングするための吸着機構とを備える構造を一例として説明する。ハンド装置3は、他の機能を備える他の構造のものが装備されていても良い。ハンド装置3は、ハンド本体31を有する。ハンド本体31は角柱形状を有し、その上方端面に取り付け部を備える。この取り付け部を介して、ハンド装置3は手首部4のアダプタ(関節部J6)に装着される。ハンド本体31の下方には、エアチャックボックス32が取り付けられる。エアチャックボックス32は一対のスライダ33を有する。一対のスライダ33は接近/離反自在に支持される。エアチャックボックス32は、エアシリンダ(図示しない)を有する。エアシリンダには一対のエアチューブが接続されている。一対のエアチューブ各々は圧縮式のエアポンプ(図示しない)に接続されている。一対のエアチューブには一対の電磁弁(図示しない)が介在されている。後述の開閉用電磁弁ドライバ301により、一方の電磁弁の開閉と他方の電磁弁の開閉とは逆相に制御される。一方の電磁弁が開放され、他方の電磁弁が閉じられているとき、一対のスライダ33は接近する方向に移動される。一方の電磁弁が閉じられ、他方の電磁弁が開放されているとき、一対のスライダ33は離反する方向に移動される。一対のスライダ33の接近/離反する方向をスライド方向という。
 一対のスライダ33には一対の把持部34が取り付けられている。把持部34は外観略円柱形状を有する。把持部34の先端には、円筒状体のパッド(吸着パッド)36が取り付けられている。一対の把持部34には一対のエアチューブが接続されている。一対のエアチューブ各々は既出のエアポンプに接続されている。把持部34には、エアチューブとの接続口からその先端まで配管経路が形成されている。これにより、エアポンプから把持部34の先端までの配管経路が確保されている。エアポンプとしては圧縮式と真空式のいずれでも良いがここでは圧縮ポンプとして説明する。把持部34のパッド36とエアポンプとの間は負圧経路と正圧経路との2系統の配管経路で接続される。負圧経路には負圧弁とエジェクタとが介在される。正圧経路には正圧弁が介在される。負圧弁と正圧弁とは電磁弁である。後述の水平吸着用電磁弁ドライバ302により負圧弁の開閉と正圧弁の開閉とは逆相に制御される。
 負圧弁が開放され正圧弁が閉じられているとき、負圧経路が確保される。負圧経路が確保されているとき、エアポンプで発生された圧縮空気は負圧弁を介してエジェクタに供給される。エジェクタは吸気口とノズルと排気口とを有する。吸気口にはパッド36の後方部分が接続されている。エジェクタに供給された圧縮空気は、ノズルから噴射され高速な空気の束となって排気口から排気される。すると、エジェクタのチャンバの内圧が低下し、これにより吸気口から空気が吸い込まれ、吸気口から吸いこまれた空気は、圧縮空気とともに排気口から排気される。これにより、吸気口に接続されたパッド36に負圧が発生する。正圧弁が開放され負圧弁が閉じられているとき、正圧経路が確保される。正圧経路が確保されているとき、エアポンプで発生された圧縮空気は直接的にパッド36に供給される。これにより、パッド36に正圧が発生する。
 一対のスライダ33には一対の吸着パッド38が取り付けられている。吸着パッド38は弾性材料として例えばシリコーン樹脂で円筒状体に成形される。吸着パッド38の先端面をワークを吸着する吸着面という。吸着パッド38の胴体部分は蛇腹形に成形される。吸着パッド38は円筒状体の軸方向の向きにワークを吸着する。この吸着方向がスライド方向に垂直になるように、吸着パッド38はスライダ33に取り付けられる。一対の吸着パッド38には、一対のエアチューブが接続されている。一対のエアチューブ各々は既出のエアポンプに接続されている。吸着パッド38とエアポンプとの間は負圧経路と正圧経路との2系統の配管経路で接続される。負圧経路には負圧弁とエジェクタとが介在される。正圧経路には正圧弁が介在される。負圧弁と正圧弁とは電磁弁である。後述の垂直吸着用電磁弁ドライバ303により負圧弁の開閉と正圧弁の開閉とは逆相に制御される。負圧弁が開放され正圧弁が閉じられているとき、負圧経路が確保される。負圧経路が確保されているとき吸着パッド38に負圧が発生する。正圧弁が開放され負圧弁が閉じられているとき、正圧経路が確保される。正圧経路が確保されているとき吸着パッド38に正圧が発生する。
 図2に詳細に示されるように直動伸縮機構はアーム部2と射出部42とを有する。アーム部2は第1連結コマ列21と第2連結コマ列22とを有する。第1連結コマ列21は複数の第1連結コマ23からなる。第1連結コマ23は略平板形に構成される。前後の第1連結コマ23は、互いの端部箇所においてピンにより屈曲自在に列状に連結される。第1連結コマ列21は内側や外側に自在に屈曲できる。
 第2連結コマ列22は複数の第2連結コマ24からなる。第2連結コマ24は横断面コ字形状の短溝状体に構成される。前後の第2連結コマ24は、互いの底面端部箇所においてピンにより屈曲自在に列状に連結される。第2連結コマ列22は内側に屈曲できる。第2連結コマ24の断面はコ字形状であるので、第2連結コマ列22は、隣り合う第2連結コマ24の側板同士が衝突して、外側には屈曲しない。なお、第1、第2連結コマ23、24の第2回転軸RA2に向いた面を内面、その反対側の面を外面というものとする。第1連結コマ列21のうち先頭の第1連結コマ23と、第2連結コマ列22のうち先頭の第2連結コマ24とは結合コマ27により接続される。例えば、結合コマ27は第2連結コマ24と第1連結コマ23とを合成した形状を有している。
 射出部42は、複数の上部ローラ43と複数の下部ローラ44とが角筒形状のフレーム45に支持されてなる。例えば、複数の上部ローラ43は第1連結コマ23の長さと略等価な間隔を隔ててアーム中心軸に沿って配列される。同様に、複数の下部ローラ44は第2連結コマ24の長さと略等価な間隔を隔ててアーム中心軸に沿って配列される。射出部42の後方には、ガイドローラ40とドライブギア41とが第1連結コマ列21を挟んで対向するように設けられる。ドライブギア41は減速器(図示しない)を介してステッピングモータ330に接続される。第1連結コマ23の内面には連結方向に沿ってリニアギアが形成されている。複数の第1連結コマ23が直線状に整列されたときに互いのリニアギアは直線状につながって、長いリニアギアを構成する。ドライブギア41は、直線状のリニアギアにかみ合わされる。直線状につながったリニアギアはドライブギア41とともにラックアンドピニオン機構を構成する。
 アーム伸長時、モータ330が駆動し、ドライブギア41が順回転すると、第1連結コマ列21はガイドローラ40により、アーム中心軸と平行な姿勢となって、上部ローラ43と下部ローラ44との間に誘導される。第1連結コマ列21の移動に伴い、第2連結コマ列22は射出部42の後方に配置されたガイドレール(図示しない)により上部ローラ43と下部ローラ44との間に誘導される。上部ローラ43と下部ローラ44との間に誘導された第1、第2連結コマ列21,22は互いに押圧される。これにより、第1、第2連結コマ列21,22による柱状体が構成される。射出部42は、第1、第2連結コマ列21,22を接合して柱状体を構成するとともに、その柱状体を上下左右に支持する。第1、第2連結コマ列21、22の接合による柱状体が射出部42により堅持されることで、第1、第2連結コマ列21,22の接合状態が保持される。第1、第2連結コマ列21、22の接合状態が維持されているとき、第1、第2連結コマ列21,22の屈曲は互いに拘束される。それにより第1、第2連結コマ列21、22は、一定の剛性を備えた柱状体を構成する。柱状体とは、第2連結コマ列22に第1連結コマ列21が接合されてなる柱状の棒体を言う。この柱状体は第2連結コマ24が第1連結コマ23とともに全体として様々な断面形状の筒状体に構成される。筒状体とは上下左右が天板、底板及び両側板で囲まれ、前端部と後端部とが開放された形状として定義される。第1、第2連結コマ列21、22の接合による柱状体は、結合コマ27が始端となって、第3移動軸RA3に沿って直線的に第3支持部13の開口から外に向かって送り出される。
 アーム収縮時、モータ330が駆動し、ドライブギア41が逆回転されると、ドライブギア41と係合している第1連結コマ列21が第1支持部11内に引き戻される。第1連結コマ列21の移動に伴って、柱状体が第3支持部13内に引き戻される。引き戻された柱状体は射出部42後方で分離される。例えば、柱状体を構成する第1連結コマ列21はガイドローラ40とドライブギア41とに挟まれ、柱状体を構成する第2連結コマ列22は重力により下方に引かれ、それにより第2連結コマ列22と第1連結コマ列21とは互いに離反される。離反された第1、第2連結コマ列21,22はそれぞれ屈曲可能な状態に復帰する。収納に際しては、射出部42から、第1支持部11(基部10)の内部の収納部に第2連結コマ列22は内側に屈曲されて搬送され、第1連結コマ列21も第2連結コマ列22と同じ方向(内側)に屈曲されて搬送される。第1連結コマ列21は第2連結コマ列22に略平行な状態で格納される。
 周知の通りロボット分野では多くの座標系が扱われる。ワールド座標系Σgは、ロボット装置が設置された工場内床面に設定された直交3軸座標系(Xg、Yg、Zg)であり、観測座標系とも言い、ロボット装置はこのワールド座標系Σgに対して作業を行なう。ユーザ座標系Σuは、ロボット装置を操作するユーザを基準とした直交3軸座標系(Xu,Yu,Zu)である。ロボット座標系Σbは、ロボット装置の基部10を基準とした座標系であり、ここでは第1関節部J1の回転軸RA1上の任意位置を原点とした直交3軸座標系である。例えば、ロボット座標系Σbにおいて、回転軸RA1上の基部10の接地面に原点、回転軸RA1にZb軸(鉛直軸)、Zb軸に直交する2軸をXb軸、Yb軸に規定する。Xb軸はロボット装置の前後軸、Yb軸は左右軸を示す。
 手首座標系Σwrは、ロボット装置の手首部4を基準とした直交3軸座標系である。例えば、第4関節部J4の回転軸RA4上の任意位置に設定した手首基準点を原点とし、第4関節部J4の回転軸RA4をXwr軸(前後軸)、第5関節部J5の回転軸RA5と平行にYwr軸(左右軸)、これら2軸に直交するZwr軸(鉛直軸)が規定されている。手首姿勢とは、手首座標系Σwrの直交3軸各々周りの回転角として、Xwr軸周りの回転角(ロール角)αwr、Ywr軸周りの回転角(ピッチ角)βwr、Zwr軸周りの回転角(ヨー角)γwrとして与えられる。
 手先座標系Σhは、ロボット装置のハンド装置3を基準とした直交3軸座標系であり、ハンド装置3の一対のパッド36の間の中央位置(手先基準点という)を原点とし、第6関節部J6の旋回軸RA6と平行にXh軸(前後軸)、Xh軸に直交する2軸をYh軸、Zh軸が規定される。Yh軸はハンド装置3の左右軸、Zh軸はハンド装置3の上下軸を示す。手先姿勢とは、手先座標系Σhの直交3軸各々周りの回転角(Xh軸周りの回転角(ロール角)αh、Yh軸周りの回転角(ピッチ角)βh、Zh軸周りの回転角(ヨー角)γhとして与えられる。
 ワーク座標系Σwoは、ハンド装置3が取り扱うワークに基準をおいた直交3軸座標系である。例えば、ワーク座標系Σwoにおいて、ワークの重心位置(ワーク基準点という)を原点として、第6関節部J6の旋回軸RA6と平行にXwo軸(前後軸)、Xwo軸に直交する2軸をYwo軸、Zwo軸が規定される。Ywo軸はワークの左右軸、Zwo軸はワークの上下軸を示す。ワーク姿勢とは、ワーク座標系Σwoの直交3軸各々周りの回転角(Xwo軸周りの回転角(ロール角)αwo、Ywo軸周りの回転角(ピッチ角)βwo、Zwo軸周りの回転角(ヨー角)γwoとして与えられる。
 図4は、本実施形態に係るロボット装置の構成を示すブロック図である。ロボット装置は、多関節アーム機構200とハンド装置3とを備える。動作制御装置100の制御に従って、多関節アーム機構200を構成する関節部J3が伸縮し、関節部J1、J2,J4-J6各々が回転され、ハンド装置3が動作される。
 多関節アーム機構200は複数の関節部J1,J2,J3,J4,J5、J6を有する。複数の関節部J1-J6各々には、ステッピングモータが設けられる。これらステッピングモータの回転はドライバユニット201により制御される。ドライバユニット201は、動作制御装置100からの位置指令値に応じたパルス信号をステッピングモータに送る。これによりステッピングモータは指令値に応じた位置まで回転する。これらステッピングモータのドライブシャフトには、一定の回転角ごとにパルスを出力するロータリエンコーダ202が接続されている。ロータリエンコーダ202から出力されたエンコードパルスは、ドライバユニット201のカウンタ(図示しない)で加減算される。カウンタで計数されたエンコードパルスの計数値は、ドライバユニットインターフェース105を介して、動作制御装置100に入力される。
 ハンド装置3は、開閉用電磁弁ドライバ301と、水平吸着用電磁弁ドライバ302と、垂直吸着用電磁弁ドライバ303とを備える。開閉用電磁弁ドライバ301は、後述のハンド操作部70を介して入力された把持部34の開閉指令に従って、エアチャック構造32の電磁弁を開閉する。これにより、一対のスライダ33が接近/離反する方向に移動される。水平吸着用電磁弁ドライバ302は、後述のハンド操作部70を介して入力されたパッド36の吸着動作のONの指令に従って、把持部34のパッド36とエアポンプとの間に介在された正圧弁を閉じ、負圧弁をハンド操作部70で操作者により設定された吸着強度に応じた開度で開放する。水平吸着用電磁弁ドライバ302は、後述のハンド操作部70を介して入力されたパッド36の吸着動作のOFFの指令に従って、把持部34のパッド36とエアポンプとの間に介在された正圧弁を開放し、負圧弁を閉じる。垂直吸着用電磁弁ドライバ303は、後述のハンド操作部70を介して入力された吸着パッド38の吸着動作のONの指令に従って、吸着パッド38とエアポンプとの間に介在された正圧弁を閉じ、負圧弁をハンド操作部70で操作者により設定された吸着強度に応じた開度で開放する。垂直吸着用電磁弁ドライバ303は、後述のハンド操作部70を介して入力された吸着パッド38の吸着動作のOFFの指令に従って、吸着パッド38とエアポンプとの間に介在された正圧弁を開放し、負圧弁を閉じる。
 動作制御装置100は、システム制御部101を中心として制御/データバス109を介して各部が接続されてなる。動作制御装置100には、ロボット装置の着目点の位置および姿勢の変更を操作者が手動操作するための2系統のアーム操作部50,60が、それぞれ第1アーム操作部インターフェース102と第2アーム操作部インターフェース103とを介して接続されている。また、動作制御装置100には、ハンド装置3の動作を操作者が操作するためのハンド操作部70がハンド操作部インターフェース104を介して接続されている。
 動作制御部106は、第1アーム操作部50又は第2アーム操作部60を介してユーザにより入力されたロボット装置の移動指示、回転指示に従って、制御周期Δt毎の関節部J1-J6各々の位置指令値を発生する。動作制御部106により発生された位置指令値はドライバユニットI/F105を介して、関節部J1-J6各々のドライバユニット201に制御周期Δtごとに送信される。
 ここでは説明の便宜上、ロボット座標系Σbを基準座標系として、手先座標系Σhを対象座標系とする。動作制御部106は、エンコーダ202の出力パルスに基づいて、関節部J1,J2,J3,J4,J5,J6の関節変数(θ1、θ2、d3、θ4、θ5、θ6)を計算する。関節変数は、関節部J1,J2,J4,J5、J6の関節角度と関節部J3の伸長距離との6変数をいう。計算した関節変数(θ1、θ2、d3、θ4、θ5、θ6)に基づいて、順運動学によりロボット座標系Σb上での手先座標系Σhの原点(手先基準点)の現在位置と手先姿勢とを計算する。
 第1アーム操作部50又は第2アーム操作部60により、並進移動が指示されると、動作制御部106は、手先基準点の現在位置とこれらアーム操作部により入力された最終目標位置とに基づいて、予め設定された軌道計算式により、制御周期Δt毎の目標位置を計算する。動作制御部106は、並進移動開始時の手先姿勢を維持した状態で、手先基準点を現在位置から目標位置に移動するための関節変数(θ1、θ2、d3、θ4、θ5、θ6)を計算し、計算した関節変数に応じた位置指令値を発生する。
 第1アーム操作部50又は第2アーム操作部60により、手先姿勢の変更が指示されると、動作制御部106は、現在の手先姿勢とこれらアーム操作部により入力された最終目標姿勢とに基づいて、手先座標系ΣhのXh軸、Yh軸、Zh軸に関する回転行列により、制御周期Δt毎の目標姿勢を計算する。動作制御部106は、並進移動開始時の手先基準点の位置を維持した状態で、手先姿勢現在の姿勢から目標姿勢に変更するための関節変数(θ1、θ2、d3、θ4、θ5、θ6)を計算し、計算した関節変数に応じた位置指令値を発生する。
 なお、基準座標系として他の座標系(ワールド座標系/ユーザ座標系)が選択された場合、又は対象座標系として他の座標系(手首座標系/ワーク座標系)、基準座標系と対象座標系との両方が他の座標系に選択された場合においても、上記と同様に、動作制御部106は、アーム操作部50,60の入力に基づいて、制御周期Δt毎の位置指令値を発生する。そのために、動作制御部106は基準座標系(ワールド座標系/ユーザ座標系/ロボット座標系)と対象座標系(手首座標系/手先座標系/ワーク座標系)との関係を定義する複数の同次変換行列のデータ、手首座標系ΣwrのXwr軸、Ywr軸、Zwr軸に関する回転行列のデータ、およびワーク座標系ΣwoのXwo軸、Ywo軸、Zwo軸に関する回転行列のデータ等を保持する。
 本実施形態に係るロボット装置は、ロボットアーム機構を操作するための2系統のアーム操作部50,60を備える。第1アーム操作部50は、本実施形態に係るロボット装置が提供可能な全て又はほとんどの移動回転動作を網羅する専門的知識の必要な主に専門員が使用するのに適した汎用性の高い操作部である。第2アーム操作部60は、本実施形態に係るロボット装置が提供可能な移動回転動作のうちいくつかの移動回転動作に限定し、それらの動きと操作ボタンとの関係を固定化することにより汎用性は低いものの高い操作習熟性が期待できる操作部である。例えば、ロボットアーム機構の操作に熟練した操作者は、第1アーム操作部50を用いて、基準座標系と対象座標系とをそれぞれ切り替えながら、効率よくロボットアーム機構を操作することが可能なものとなっている。ロボットアーム機構の操作に不慣れな習熟度の低い者は、第2アーム操作部60を用いて容易にロボットアーム機構を操作することができる。
 第1アーム操作部50は、本実施形態に係るロボット装置が提供可能な移動回転動作を網羅するための複数のボタンを装備する。本実施形態に係るロボット装置は、以下の移動回転動作を提供する。 
(1)並進移動 
 並進移動とは、基準座標系上での対象座標系の各軸角度差(姿勢)を維持した状態で、基準座標系に対する対象座標系の原点の相対的な位置が連続的に変化する移動を一般的には言うものであるが、ここでは対象座標系の原点が基準座標系のいずれか1軸に関する座標が変化する移動に限定的に用いるものとする。基準座標系として、ワールド座標系Σg、ユーザ座標系Σuおよびロボット座標系Σbのうち一が、ユーザにより選択される。対象座標系として、手首座標系Σwr、手先座標系Σhおよびワーク座標系Σwoのうち一が、ユーザにより選択される。例えば、基準座標系としてロボット座標系Σb、対象座標系として手先座標系Σhが選択された場合を想定する。このとき、並進移動操作が開始されると、並進移動操作開始時のロボット座標系Σb上での手先姿勢を維持した状態で、手先がロボット座標系Σbの直交3軸の各軸に沿って移動される。なお、対象座標系として手首座標系Σwrが選択された場合、基準座標系上での手首姿勢を維持した状態で、手首が基準座標系の直交3軸のいずれか1軸に沿って移動される。また、対象座標系としてワーク座標系Σwoが選択された場合、基準座標系上でのワーク姿勢を維持した状態で、ワークが基準座標系の直交3軸の各軸に沿って移動される。
(2)並進移動の混合動作 
 並進移動の混合動作は、基準座標系上の直交3軸のうち1軸の並進移動に他の1又は2軸の並進移動をされる移動をいうものという。 
(3)手首姿勢の変更 
 手首姿勢の変更とは、手首座標系Σwrの原点が基準座標系上で固定された状態で、基準座標系上で手首座標系ΣwrがそのXwr軸周りに回転し(ロールαwr)、Ywr軸周りに回転し(ピッチβwr)、Zwr軸周りに回転(ヨーγwr)することにより手首姿勢が変更される動作をいう。手首に着目した姿勢変更は、対象座標系として手首座標系Σwrが選択された場合に行われる。
(4)手先姿勢の変更 
 手先姿勢の変更とは、手先座標系Σhの原点が基準座標系上で固定された状態で、基準座標系上で手先座標系ΣhがそのXh軸周りに回転し(ロールαh)、Yh軸周りに回転し(ピッチβh)、Zh軸周りに回転(ヨーγh)することにより手先姿勢が変更される動作をいう。手先に着目した姿勢変更は、対象座標系として手先座標系Σhが選択された場合に行われる。
(5)ワーク姿勢の変更 
 ワーク姿勢の変更とは、ワーク座標系Σwoの原点が基準座標系上で固定された状態で、基準座標系上でワーク座標系ΣwoがそのXwo軸周りに回転し(ロールαwo)、Ywo軸周りに回転し(ピッチβwo)、Zh軸周りに回転(ヨーγwo)することによりワーク姿勢が変更される動作をいう。ワークに着目した姿勢変更は、対象座標系としてワーク座標系Σwoが選択された場合に行われる。 
(6)回転軸毎の回転動作 
 回転軸毎の回転動作とは、基準座標系および対象座標系に依らず、複数の関節部J1-J6がそれぞれの回転軸RA1-RA6周りに個別に正負回転する動作をいう。
 これら多種動作をユーザが入力操作するための操作ボタンが第1アーム操作部50には装備される。第1アーム操作部50には、並進移動のための基準座標系としてワールド座標系Σg、ユーザ座標系Σuおよびロボット座標系Σbの一の座標系をユーザが任意に設定するためのボタン、上述した対象座標系として手首座標系Σwr、手先座標系Σhおよびワーク座標系Σwoのうち一をユーザが任意に設定するためのボタンが設けられる。第1アーム操作部50には、姿勢変更のための対象座標系として手首座標系Σwr、手先座標系Σhおよびワーク座標系Σwoのうち一をユーザが任意に設定するためのボタンが設けられる。
 また第1アーム操作部50には、上記選択した対象座標系の着目点(原点)の並進移動を入力操作するための6個の操作ボタンが装備される。並進移動を入力操作するための6個の操作ボタンには、移動軸に関して基準座標系の直交3軸のいずれか、移動方向に関して各軸の正負いずれかが個々に対応つけられる。
 さらに第1アーム操作部50には、姿勢変更を入力操作するための6個の操作ボタンが装備される。姿勢変更を入力操作するための6個の操作ボタンには、回転軸に関して対象座標系の直交3軸のいずれか、回転方向に関して各軸の正負いずれかが個々に対応つけられる。
 第1アーム操作部50には、関節部J1-J6各々を個別に正負回転させるための12個の操作ボタンが装備される。また、これら移動回転に係る操作ボタンとは別に、移動速度(回転速度)を調整するための複数の調整ボタンが装備されるかもしれない。これらボタンは物理的ボタンの実装により構成されてもよいし、タッチパネルを装備したディスプレイにより構成されていてもよいし、これらの組み合わせにより構成されてもよい。
 第2アーム操作部60は、片手で保持が可能な重量及びサイズに形成され、矩形の平面形状を備えた操作パネルに、上記ロボット装置の移動回転動作の中の限定的な移動回転動作をユーザが入力操作するための操作ボタンが装備されてなる。第2アーム操作部60は、ロボット装置が提供可能な移動回転動作(上記の(1)-(6))のうち、並進移動(2)と手先姿勢の変更(4)とに限定した入力操作のための複数のボタンが限定的に装備されている。並進移動に関しては、基準座標系としてロボット座標系Σb、対象座標系としては手先座標系Σhに固定されている。姿勢変更に関しては、対象座標系としては並進移動と同じ手先座標系Σhに固定されている。
 図5は、図4の第2アーム操作部60の操作パネル構造を示す平面図である。第2アーム操作部60には、ロボット座標系Σb上で手先を並進移動させるための第1操作ボタンセット(601-606)と手先姿勢を変更するための第2操作ボタンセット(611-616)とが装備されている。
 具体的には、第1操作ボタンセットは、ロボット座標系Σbの直交3軸の各軸に関する正負移動を入力操作するための6個の物理的押しボタン601-606からなる。これら6個の押しボタン601-606各々には、対応する移動方向が文字(上、下、前、後、左、右)により表記されている。第2操作ボタンセットは、手先座標系Σhの直交3軸の各軸に関する正負回転を入力操作をするための6個の物理的押しボタン611-616からなる。これら6個の押しボタン各々には、対応する軸およびその軸周りの回転方向が図柄により表記されている。
 第1操作ボタンセットの6個の押しボタン601-606は第2アーム操作部60の上部に配設されている。第1操作ボタンセットの6個の押しボタン601-606のうち、ロボット座標系Σb上の前後移動に係る2個の押しボタン601,602が操作パネルの長手方向(縦方向)に並設され、左右移動に係る2個の押しボタン603,604が操作パネルの短手方向(幅方向、横方向)に並設される。つまりロボット座標系Σb上の前後左右移動に係る4個の押しボタン601-604が十字に配設される。また、ロボット座標系Σb上の上下移動に係る2個の押しボタン605,606が、4個の押しボタン601-604の右隣の領域に縦方向に並設される。押しボタン601,602は、ロボット座標系ΣbのXh軸の正負方向にそれぞれ対応する。押しボタン603,604は、ロボット座標系ΣbのYh軸の正負方向にそれぞれ対応する。押しボタン605,606は、ロボット座標系ΣbのZh軸の正負方向にそれぞれ対応する。例えば、押しボタン601には、移動方向を表す文字「前」が表記されている。押しボタン601が押されている間、ハンド装置3の姿勢が維持された状態で、ハンド装置3がロボット座標系Σb上のXh軸の正方向に既定速度で並進移動される。押しボタン602には、移動方向を表す文字「後」が表記されている。押しボタン602が押されている間、ハンド装置3の姿勢が維持された状態で、ハンド装置3がロボット座標系Σb上のXh軸の負方向に既定速度で並進移動される。
 第2アーム操作部60の下部であって、第1操作ボタンセットの下方には、第2操作ボタンセットの6個の押しボタン611-616が配設されている。第2操作ボタンセットの6個の押しボタン611-616は手先座標系Σhの直交3軸の各軸ごとに2個ずつ、第2アーム操作部60の幅方向に分散されている。直交3軸の各軸ごとに設けられた2個の押しボタンは第2アーム操作部60の縦方向に配列されている。直交3軸の各軸ごとに設けられた2個の押しボタンの下方に、対応する回転軸の位置を示す絵柄617-619が表記されている。操作ボタン611、612はXh軸周りの(+)/(-)の回転(ロールαh)に対応する。操作ボタン613、614はYh軸周りの(+)/(-)の回転(ピッチβh)に対応する。操作ボタン615、616は手先座標系ΣhのZh軸周りの(+)/(-)の回転(ヨーγh)に対応する。例えば、押しボタン611が押されている間、ハンド装置3が図柄617に表記されたXh軸周りに、押しボタン611に表記されている方向に既定速度で回転される。
 第2操作ボタンセットの下方には、第2アーム操作部60を起動するための電源ボタン621、第2アーム操作部60の操作を無効にするための緊急停止ボタン620、第2アーム操作部60が起動中か否かを操作者に通知するためのインジケータランプ623、及び操作ボタンが押されているか否かを操作者に通知するためのインジケータランプ624が配設されている。
 図6は、図4の第2アーム操作部60の他の操作パネル構造を示す平面図である。図5と同様に、第1操作ボタンセットを構成する6個の押しボタン601-606が第2アーム操作部60の上部に配設されている。また、図5と同様に、第1操作ボタンセットの下方に第2操作ボタンセットを構成する6個の押しボタン611-616が配設されている。図6に示すように、第2操作ボタンセットの下方に手先座標系Σhの直交3軸の各軸の向きを示す図柄630が表記されている。例えば、この図柄630は動作対象、ここではロボット装置の手先の概形を表す。この図柄630で表記されている直交3軸の各軸と、各軸ごとに設けられた2個の押しボタンとは、引き出し線により関連付けされている。手先座標系Σhの直交3軸の各軸の向きを示す図柄630の下方には、電源ボタン621と緊急停止ボタン620とインジケータランプ623,624が配設されている。1つの図柄630で、手先座標系Σhの直交3軸の各軸の向きを示すことで、操作者は各軸の位置関係をより簡易に理解することができるため、回転操作の操作容易性の向上が実現される。
 図7は、図4の第2アーム操作部60の他の操作パネル構造を示す平面図である。ここでは、第2アーム操作部60は、ロボット装置が提供可能な移動回転動作(上記の(1)-(6))のうち、並進移動(2)と回転軸毎の回転動作(6)とだけを操作者が入力するための複数のボタンが装備されている。この並進移動において、基準座標系はロボット座標系Σb、対象座標系は手先座標系Σhに固定されている。
 第2アーム操作部60には、ロボット座標系Σb上で手先を並進移動させるための第1操作ボタンセットと、手首3軸各々を直接回転させるための第2操作ボタンセットとが装備されている。図5と同様に、第1操作ボタンセットを構成する6個の押しボタン601-606が第2アーム操作部60の上部に配設されている。第1操作ボタンセットの下方に、第2操作ボタンセットが配設されている。第2操作ボタンセットの下方には、電源ボタン621と緊急停止ボタン620とインジケータランプ623,624が配設されている。図7に示す他の操作パネル構造において、第2操作ボタンセットは、手首3軸の各軸に関する正負回転を入力操作をするための6個の物理的押しボタン641-646からなる。これら6個の押しボタン641-646各々には、対応する軸およびその軸周りの回転方向が図柄により表記されている。6個の押しボタン641-646は、手首3軸の各軸ごとに2個ずつ、第2アーム操作部60の幅方向に分散されている。手首3軸の各軸ごとに設けられた2個の押しボタンは第2アーム操作部60の縦方向に分散されている。手首3軸の各軸ごとに設けられた2個の押しボタンの下方に、対応する回転軸の位置を示す図柄647-649が表記されている。操作ボタン641、642は第4関節部J4の回転軸RA4周りの(+)/(-)の回転に対応する。操作ボタン643、644は第5関節部J5の回転軸RA5周りの(+)/(-)の回転に対応する。操作ボタン645、646は第6関節部J6の回転軸RA6周りの(+)/(-)の回転に対応する。例えば、押しボタン641が押されている間、手首部4及びハンド装置3は第4関節部J4と共に、回転軸RA4周りに押しボタン641に表記されている方向に既定速度で回転される。
 図8は、図4のハンド操作部70の操作パネル構造を示す平面図である。ハンド操作部70には、その上部にハンド装置3の一対の把持部34を開閉するための複数の操作ボタン701、702がハンド操作部70の幅方向に分散して配置されている。これら操作ボタン701,702には、開閉が文字により表記されている。複数の操作ボタン701,702の下方には、把持部34のパッド36の吸着動作をON/OFFするための複数の操作ボタン711,712がハンド操作部70の幅方向に分散して配置されている。これら操作ボタン711、712には、それぞれ「ON」、「OFF」が文字により表記されている。複数の操作ボタン711,712の隣には、把持部34のパッド36の吸着動作の吸着力を操作者が任意に選択するための複数の選択ボタン713,714、715が配置されている。複数の選択ボタン713,714、715は、ハンド操作部70の幅方向に分散されている。複数の選択ボタン713,714,715には、吸着力の強さを表す文字(「強」、「中」、「弱」)がそれぞれ表記されている。複数の操作ボタン711,712の下方には、吸着パッド38の吸着動作をON/OFFするための複数の操作ボタン721,722がハンド操作部70の幅方向に分散して配置されている。これら操作ボタン721、722には、それぞれ「ON」、「OFF」が文字により表記されている。複数の操作ボタン721,722の隣には、吸着パッド38の吸着動作の吸着力を操作者が任意に選択するための複数の選択ボタン723,724、725が配置されている。複数の選択ボタン723,724、725は、ハンド操作部70の幅方向に分散されている。複数の選択ボタン723,724,725には、吸着力の強さを表す文字(「強」、「中」、「弱」)がそれぞれ表記されている。複数の操作ボタン721,722の下方には、ハンド操作部70を起動するための電源ボタン731、ハンド操作部70の操作を無効にするための緊急停止ボタン730、ハンド操作部70が起動中か否かを操作者に通知するためのインジケータランプ733、及び操作ボタンが押されているか否かを操作者に通知するためのインジケータランプ734が配設されている。
 上述したようにロボット装置のアーム機構に関する移動回転動作から選択された限定的な動作の入力操作に限定した第2アーム操作部60を、全動作の入力操作を網羅した第1アーム操作部50とは別体で設けたことにより、操作者が自身の操作習熟の程度に応じて操作部を選択的に使用することができる。
 第2アーム操作部60では、並進移動の基準座標系、対象座標系をロボット座標系、手先座標系に設定し、それらを操作ボタンに対して固定化させたこと、さらに姿勢変更の対象座標系を並進移動の対象座標系と同じ手先座標系に設定したことにより、それら座標系の方向はアーム機構及びハンド部の形状等から非常にわかり易く、アーム機構及びハンド部の上下・左右・前後を視認しながらそれに応じて入力操作をすることができ、それは他の座標系に比べて動作予測性が高いといえ、操作を短期間のうちに上達させる事が可能となる。
 また第2アーム操作部60では対象動作ごとに独立した物理的な押しボタンを装備させることにより、その構造上、2又はそれ以上の動作を混合して同時に入力操作をすることを回避させることができ、意図した動作と異なる不測の動作が実行されることによる煩雑さを解消する事ができる。それは、並進移動の6個の押しボタンにはそれぞれ対応する移動方向を文字により表記し、姿勢変更の6個の押しボタンにはそれぞれ対応する回転方向を図柄により表記したことにより、さらに向上し得る。
 並進移動に係る6個の押しボタンを操作部の上部に、姿勢変更にかかる6個の押しボタンを操作部の下部にそれぞれ分離して配設したこと、そして並進移動に係る6個の押しボタンのうち前後左右移動に係る4個の押しボタンを十字に配置し、上下移動に係る2個の押しボタンを4個の押しボタンの隣に配置し、さらに姿勢変更に係る6個の押しボタンを直交3軸の回転軸ごとに並設し、このようなボタン配置は操作パネルを視認することなく指先の触覚により、ボタンを識別する事が容易になり、アーム機構及びハンド部から視点を動かすことなく正確な入力操作を実現する。
 本発明のいくつかの実施形態を説明したが、これらの実施形態は、例として提示したものであり、発明の範囲を限定することは意図していない。これら実施形態は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、変更を行うことができる。これら実施形態やその変形は、発明の範囲や要旨に含まれると同様に、特許請求の範囲に記載された発明とその均等の範囲に含まれるものである。
 50…第1アーム操作部、60…第2アーム操作部、70…ハンド操作部、100…制御装置、101…システム制御部、102…第1アーム操作部インターフェース、103…第2アーム操作部インターフェース、104…ハンド操作部インターフェース、105…ドライバユニットインターフェース、106…動作制御部。

Claims (9)

  1.  先端に手先効果器を装備可能な複数の関節部を有するロボットアーム機構と、
     前記手先効果器の移動及び姿勢変更について操作者が入力操作をするための操作部と、
     前記操作部を介した入力操作に従って前記関節部の駆動を制御する制御部とを具備し、
     前記操作部には、前記ロボットアーム機構のロボット座標系上での前記手先効果器の姿勢が固定された状態で前記手先効果器が前記ロボット座標系の直交3軸の各軸に沿って正負に移動する並進移動に関する第1操作ボタンセットと、前記ロボット座標系上での前記手先効果器の手先座標系の原点位置が固定した状態で前記手先座標系の直交3軸の各軸を回転中心として前記手先効果器が正負に回転する姿勢変更動作に関する第2操作ボタンセットとが前記ロボットアーム機構の移動回転に係る動作入力操作手段として限定的に装備されていることを特徴とするロボット装置。
  2.  前記並進移動に加えて前記並進移動以外の他の移動と前記姿勢変更に加えて前記姿勢変更以外の他の姿勢変更とについて操作者が入力操作をするための他の操作部をさらに具備することを特徴とする請求項1記載のロボット装置。
  3.  前記第1操作ボタンセットは、前記ロボット座標系の直交3軸の各軸に関する正負移動を入力操作するための6個の物理的押しボタンからなることを特徴とする請求項1記載のロボット装置。
  4.  前記第2操作ボタンセットは、前記手先座標系の直交3軸の各軸に関する正負回転を入力操作をするための6個の物理的押しボタンからなることを特徴とする請求項3記載のロボット装置。
  5.  前記第1操作ボタンセットの6個の押しボタンにはそれぞれ対応する移動方向が文字により表記され、前記第2操作ボタンセットの6個の押しボタンにはそれぞれ対応する回転方向が図柄により表記されることを特徴とする請求項4記載のロボット装置。
  6.  前記第1操作ボタンセットの6個の押しボタンは前記操作部の上部に配設され、前記第1操作ボタンセットの6個の押しボタンのうち前記ロボット座標系上の前後左右移動に係る4個の押しボタンが十字に近接配置され、前記ロボット座標系上の上下移動に係る2個の押しボタンが前記4個の押しボタンの隣に近接配置され、
     前記第2操作ボタンセットの6個の押しボタンは前記操作部の下部に配設され、前記第2操作ボタンセットの6個の押しボタンは前記手先座標系の直交3軸の各軸ごとに近接配置されることを特徴とする請求項5記載のロボット装置。
  7.  前記複数の関節部の個別入力操作ボタンセット、前記第1、第2操作ボタンセット、前記第1操作ボタンセットとは異なる座標系の直交3軸の各軸に沿って前記手先効果器が正負に移動する動作に関するボタンセット、前記第2操作ボタンセットとは異なる座標系の直交3軸の各軸を回転中心として前記手先効果器が正負に回転する動作に関するボタンセットが装備された他の操作部がさらに具備されることを特徴とする請求項1記載のロボット装置。
  8.  前記ロボットアーム機構は、基部と、前記基部の略中心線に係る第1軸回りのねじり回転のための関節部と、前記第1軸に直交する第2軸回りの曲げ回転のための関節部と、前記第2軸に直交する第3軸に沿った直動伸縮のための関節部と、手首3軸を構成する関節部とを有することを特徴とする請求項1記載のロボット装置。
  9.  先端に手先効果器を装備可能な複数の関節部を有するロボットアーム機構と、
     前記手先効果器の移動及び姿勢変更について操作者が入力操作をするための操作部と、
     前記操作部を介した入力操作に従って前記関節部の駆動を制御する制御部とを具備し、
     前記操作部には、前記手先効果器の並進移動に関する第1操作ボタンセットと、前記手先効果器の姿勢変更に関する第2操作ボタンセットとが前記ロボットアーム機構の移動回転に係る動作入力操作手段として限定的に装備され、前記第1操作ボタンセットに対して前記並進移動に関する基準座標系と対象座標系とは固定され、前記第2操作ボタンセットに対して前姿勢変更に関する基準座標系と対象座標系とは固定され、前記姿勢変更に関する基準座標系と対象座標系とは前記並進移動に関する基準座標系と対象座標系とに対してそれぞれ同一であることを特徴とするロボット装置。
PCT/JP2016/076473 2015-09-11 2016-09-08 ロボット装置 WO2017043583A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2017539221A JP6791859B2 (ja) 2015-09-11 2016-09-08 ロボット装置
EP16844444.6A EP3348360A4 (en) 2015-09-11 2016-09-08 ROBOTIC DEVICE
CN201680065548.1A CN108349089A (zh) 2015-09-11 2016-09-08 机器人装置
US15/918,426 US20180207803A1 (en) 2015-09-11 2018-03-12 Robot apparatus

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2015179659 2015-09-11
JP2015-179659 2015-09-11

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US15/918,426 Continuation US20180207803A1 (en) 2015-09-11 2018-03-12 Robot apparatus

Publications (1)

Publication Number Publication Date
WO2017043583A1 true WO2017043583A1 (ja) 2017-03-16

Family

ID=58240709

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2016/076473 WO2017043583A1 (ja) 2015-09-11 2016-09-08 ロボット装置

Country Status (6)

Country Link
US (1) US20180207803A1 (ja)
EP (1) EP3348360A4 (ja)
JP (1) JP6791859B2 (ja)
CN (1) CN108349089A (ja)
TW (1) TW201718203A (ja)
WO (1) WO2017043583A1 (ja)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6468804B2 (ja) * 2014-10-30 2019-02-13 ライフロボティクス株式会社 ロボットアーム機構
JP6632487B2 (ja) * 2016-07-13 2020-01-22 キヤノン株式会社 連続体ロボット、その運動学の補正方法、および連続体ロボットの制御方法
JP7007839B2 (ja) * 2017-08-31 2022-01-25 川崎重工業株式会社 多関節ロボット
CN107520841A (zh) * 2017-09-29 2017-12-29 英华达(上海)科技有限公司 可变轴数的机器人及其控制方法
WO2023085879A1 (ko) * 2021-11-12 2023-05-19 주식회사 리브스메드 수술용 로봇 암

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02279289A (ja) * 1989-04-20 1990-11-15 Tokico Ltd 工業用ロボット
JP2005193338A (ja) * 2004-01-08 2005-07-21 Matsushita Electric Ind Co Ltd 産業用ロボット
JP2006289531A (ja) * 2005-04-07 2006-10-26 Seiko Epson Corp ロボット位置教示のための移動制御装置、ロボットの位置教示装置、ロボット位置教示のための移動制御方法、ロボットの位置教示方法及びロボット位置教示のための移動制御プログラム
JP2009241541A (ja) * 2008-03-31 2009-10-22 Yushin Precision Equipment Co Ltd 成形品取出機
WO2011152265A1 (ja) * 2010-05-31 2011-12-08 独立行政法人産業技術総合研究所 直動伸縮アーム機構および当該直動伸縮アーム機構を備えたロボットアーム
JP2014176955A (ja) * 2013-02-15 2014-09-25 Kobe Steel Ltd ロボットペンダント

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60170811U (ja) * 1984-04-13 1985-11-12 日本電気株式会社 ロボツト教示装置
US4979949A (en) * 1988-04-26 1990-12-25 The Board Of Regents Of The University Of Washington Robot-aided system for surgery
US7074179B2 (en) * 1992-08-10 2006-07-11 Intuitive Surgical Inc Method and apparatus for performing minimally invasive cardiac procedures
US5617515A (en) * 1994-07-11 1997-04-01 Dynetics, Inc. Method and apparatus for controlling and programming a robot or other moveable object
US6436107B1 (en) * 1996-02-20 2002-08-20 Computer Motion, Inc. Method and apparatus for performing minimally invasive surgical procedures
GB2417090A (en) * 2003-04-28 2006-02-15 Stephen James Crampton CMM arm with exoskeleton
EP3045273B1 (en) * 2006-03-03 2018-12-12 Universal Robots A/S Joint for a robot
JP5144035B2 (ja) * 2006-05-31 2013-02-13 株式会社ダイヘン 産業用ロボットのツールの位置・姿勢制御方法及び制御システム
JP2009166076A (ja) * 2008-01-15 2009-07-30 Kobe Steel Ltd 溶接ロボット
JP5547626B2 (ja) * 2010-12-28 2014-07-16 川崎重工業株式会社 7軸多関節ロボットの制御装置および教示方法
JP6095361B2 (ja) * 2012-12-26 2017-03-15 株式会社ダイヘン ロボット制御システム
JP5742862B2 (ja) * 2013-03-18 2015-07-01 株式会社安川電機 ロボット装置及び被加工物の製造方法
CN105269578B (zh) * 2014-07-01 2020-03-06 精工爱普生株式会社 指示装置以及机器人系统
JP6379874B2 (ja) * 2014-08-29 2018-08-29 株式会社安川電機 ティーチングシステム、ロボットシステムおよびティーチング方法
CN104772754B (zh) * 2015-03-26 2016-05-11 北京欣奕华科技有限公司 一种机器人示教器及示教方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02279289A (ja) * 1989-04-20 1990-11-15 Tokico Ltd 工業用ロボット
JP2005193338A (ja) * 2004-01-08 2005-07-21 Matsushita Electric Ind Co Ltd 産業用ロボット
JP2006289531A (ja) * 2005-04-07 2006-10-26 Seiko Epson Corp ロボット位置教示のための移動制御装置、ロボットの位置教示装置、ロボット位置教示のための移動制御方法、ロボットの位置教示方法及びロボット位置教示のための移動制御プログラム
JP2009241541A (ja) * 2008-03-31 2009-10-22 Yushin Precision Equipment Co Ltd 成形品取出機
WO2011152265A1 (ja) * 2010-05-31 2011-12-08 独立行政法人産業技術総合研究所 直動伸縮アーム機構および当該直動伸縮アーム機構を備えたロボットアーム
JP2014176955A (ja) * 2013-02-15 2014-09-25 Kobe Steel Ltd ロボットペンダント

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP3348360A4 *

Also Published As

Publication number Publication date
US20180207803A1 (en) 2018-07-26
JPWO2017043583A1 (ja) 2018-07-05
EP3348360A4 (en) 2019-09-25
TW201718203A (zh) 2017-06-01
EP3348360A1 (en) 2018-07-18
CN108349089A (zh) 2018-07-31
JP6791859B2 (ja) 2020-11-25

Similar Documents

Publication Publication Date Title
WO2017043583A1 (ja) ロボット装置
US7673537B2 (en) Parallel manipulator
US20180099422A1 (en) Robot device and motor control device
US20160259417A1 (en) Hand exoskeleton force feedback system
JP2018001385A (ja) パラレルリンク装置、産業用ロボット、及び力覚提示装置
JP6443875B2 (ja) ロボットアーム機構
CN107148328B (zh) 机械臂机构
JP2018069342A (ja) 制御装置、ロボットおよびロボットシステム
WO2016175157A1 (ja) 多関節アーム機構の動作制御装置及びロボット装置
US20180079077A1 (en) Robot device and stepping motor control device
WO2016084932A1 (ja) ロボット装置及びロボット制御装置
CN105666518A (zh) 一种欠驱动的仿人灵巧手
WO2016104290A1 (ja) ロボットシステム及びロボット装置
KR101213452B1 (ko) 4자유도 병렬기구를 이용한 마스터?슬레이브 시스템
TW201628810A (zh) 機械臂機構及直動伸縮機構
CN102579137B (zh) 一种可实现三维平动一维转动的并联手术机械手
CN103895008A (zh) 一种仅含转动副的空间三平动并联机器人机构
JP2017052072A (ja) ロボット装置
JP6633296B2 (ja) ロボット装置及びダイレクトティーチング制御装置
CN110722573A (zh) 辅助运动机械臂及护理床
JP2016101651A (ja) ロボット装置
CN211163964U (zh) 辅助运动机械臂及护理床
JP7011426B2 (ja) マニピュレータシステム
Zhao et al. In-hand manipulation using a 3-PRS-finger-based parallel dexterous hand with bidirectional pinching capability
JP2017226021A (ja) ロボット、ロボット制御装置およびロボットシステム

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 16844444

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2017539221

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

WWE Wipo information: entry into national phase

Ref document number: 2016844444

Country of ref document: EP