WO2018079771A1 - 近接センサ装置及びロボットアーム機構 - Google Patents

近接センサ装置及びロボットアーム機構 Download PDF

Info

Publication number
WO2018079771A1
WO2018079771A1 PCT/JP2017/039101 JP2017039101W WO2018079771A1 WO 2018079771 A1 WO2018079771 A1 WO 2018079771A1 JP 2017039101 W JP2017039101 W JP 2017039101W WO 2018079771 A1 WO2018079771 A1 WO 2018079771A1
Authority
WO
WIPO (PCT)
Prior art keywords
proximity sensor
sensor device
base plate
robot arm
detected
Prior art date
Application number
PCT/JP2017/039101
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 CN201780063557.1A priority Critical patent/CN109844894B/zh
Priority to DE112017005497.4T priority patent/DE112017005497T5/de
Priority to JP2018547821A priority patent/JP6829264B2/ja
Publication of WO2018079771A1 publication Critical patent/WO2018079771A1/ja
Priority to US16/393,700 priority patent/US11407121B2/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/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/081Touching devices, e.g. pressure-sensitive
    • B25J13/084Tactile sensors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/086Proximity sensors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06Safety devices
    • HELECTRICITY
    • H01ELECTRIC ELEMENTS
    • H01HELECTRIC SWITCHES; RELAYS; SELECTORS; EMERGENCY PROTECTIVE DEVICES
    • H01H36/00Switches actuated by change of magnetic field or of electric field, e.g. by change of relative position of magnet and switch, by shielding
    • HELECTRICITY
    • H03ELECTRONIC CIRCUITRY
    • H03KPULSE TECHNIQUE
    • H03K17/00Electronic switching or gating, i.e. not by contact-making and –breaking
    • H03K17/94Electronic switching or gating, i.e. not by contact-making and –breaking characterised by the way in which the control signals are generated
    • H03K17/945Proximity switches
    • H03K17/955Proximity switches using a capacitive detector
    • HELECTRICITY
    • H03ELECTRONIC CIRCUITRY
    • H03KPULSE TECHNIQUE
    • H03K17/00Electronic switching or gating, i.e. not by contact-making and –breaking
    • H03K17/94Electronic switching or gating, i.e. not by contact-making and –breaking characterised by the way in which the control signals are generated
    • H03K17/96Touch switches
    • H03K17/962Capacitive touch switches
    • HELECTRICITY
    • H03ELECTRONIC CIRCUITRY
    • H03KPULSE TECHNIQUE
    • H03K17/00Electronic switching or gating, i.e. not by contact-making and –breaking
    • H03K17/94Electronic switching or gating, i.e. not by contact-making and –breaking characterised by the way in which the control signals are generated
    • H03K17/96Touch switches
    • H03K17/962Capacitive touch switches
    • H03K17/9622Capacitive touch switches using a plurality of detectors, e.g. keyboard
    • HELECTRICITY
    • H03ELECTRONIC CIRCUITRY
    • H03KPULSE TECHNIQUE
    • H03K17/00Electronic switching or gating, i.e. not by contact-making and –breaking
    • H03K17/94Electronic switching or gating, i.e. not by contact-making and –breaking characterised by the way in which the control signals are generated
    • H03K17/96Touch switches
    • H03K2017/9602Touch switches characterised by the type or shape of the sensing electrodes
    • H03K2017/9604Touch switches characterised by the type or shape of the sensing electrodes characterised by the number of electrodes
    • H03K2017/9606Touch switches characterised by the type or shape of the sensing electrodes characterised by the number of electrodes using one electrode only per touch switch

Definitions

  • Embodiments of the present invention relate to a proximity sensor device and a robot arm mechanism.
  • articulated robot arm mechanisms have been used in various fields such as industrial robots.
  • the linear motion expansion / contraction mechanism put into practical use by the inventors can eliminate the need for an elbow joint from the vertical articulated robot arm mechanism, making it possible to install a robot near workers without the need for a safety fence.
  • the environment where robots and workers collaborate has become realistic.
  • ensuring the high safety is important because the robot arm mechanism is located near the worker.
  • a type equipped with a proximity sensor device that controls the robot arm mechanism such as emergency stop according to the output of the proximity sensor device. Proximity may not be detected due to failure or other factors. In that case, the worker or the like comes into contact with the proximity sensor device. Therefore, it is necessary to equip the robot arm mechanism with a contact sensor in addition to the proximity sensor.
  • the purpose is to provide a proximity sensor device that can detect contact with proximity in a simple configuration.
  • a proximity sensor device includes a detection electrode that forms a capacitance with a detection target, a base plate on which the detection electrode is mounted, and a detection unit that detects the capacitance.
  • the base plate is supported by a pushbutton switch or a pressure sensor.
  • FIG. 1 is a perspective view showing an appearance of the robot arm mechanism according to the present embodiment.
  • FIG. 2 is a side view of the robot arm mechanism of FIG.
  • FIG. 3 is a diagram showing an internal configuration of the robot arm mechanism of FIG.
  • FIG. 4 is a diagram showing the configuration of the robot arm mechanism of FIG.
  • FIG. 5 is a diagram showing a sensor main body of the proximity sensor device of FIG. 6 is an exploded view showing the internal structure of the sensor body of FIG.
  • FIG. 7 is a cross-sectional view taken along the line AA of the sensor main body of FIG.
  • FIG. 8 is a first supplemental explanatory diagram for explaining the operation of the proximity sensor device of FIG. 5.
  • FIG. 9 is a second supplemental explanatory diagram for explaining the operation of the proximity sensor device of FIG. 5.
  • FIG. 10 is a diagram showing a configuration of the proximity sensor device of FIG.
  • FIG. 11 is a diagram showing another structure of the proximity sensor device of FIG.
  • the proximity sensor device according to the present embodiment is typically installed in a robot arm mechanism.
  • the proximity sensor device can be used as another device for other devices.
  • a robot arm mechanism equipped with the proximity sensor device according to the present embodiment will be described as an example.
  • one joint portion of the plurality of joint portions is constituted by a linear motion extension / contraction mechanism.
  • a robot arm mechanism provided with a linear motion expansion / contraction mechanism is used, but the proximity sensor device according to the present embodiment can also be provided for other types of robot arm mechanisms.
  • components having substantially the same function and configuration are denoted by the same reference numerals, and redundant description will be given only when necessary.
  • FIG. 1 shows the appearance of a robot arm mechanism equipped with a proximity sensor device according to this embodiment.
  • FIG. 2 is a side view of the robot arm mechanism of FIG.
  • FIG. 3 is a side view showing the internal structure of the robot arm mechanism of FIG.
  • the robot arm mechanism includes a base 1, a turning part 2, a undulation part 4, an arm part 5, and a wrist part 6.
  • the swivel unit 2, the undulating unit 4, the arm unit 5, and the wrist unit 6 are arranged in order from the base 1.
  • the plurality of joint portions J1, J2, J3, J4, J5, and J6 are arranged in order from the base 1.
  • the base 1 is typically provided with a swivel portion 2 that forms a cylindrical body vertically.
  • the swivel unit 2 houses a first joint J1 as a swivel rotary joint.
  • the first joint portion J1 includes a rotation axis RA1.
  • the rotation axis RA1 is parallel to the vertical direction.
  • the swivel unit 2 has a lower frame 21 and an upper frame 22.
  • One end of the lower frame 21 is connected to the fixed portion of the first joint portion J1.
  • the other end of the lower frame 21 is connected to the base 1.
  • the lower frame 21 is covered with a cylindrical housing 31.
  • the upper frame 22 is connected to the rotating portion of the first joint portion J1, and rotates about the rotation axis RA1.
  • the upper frame 22 is covered with a cylindrical housing 32.
  • First and second frame rows 51 and 52 of a third joint portion J3 serving as a linear motion extending / contracting mechanism to be described later are housed in the hollow interior of the swivel portion 2 forming a cylindrical body.
  • the undulation part 4 that houses the second joint part J2 as the undulation rotation joint part is installed on the upper part of the turning part 2.
  • the second joint portion J2 is a rotary joint.
  • the rotation axis RA2 of the second joint portion J2 is perpendicular to the rotation axis RA1.
  • the undulating part 4 has a pair of side frames 23 as a fixing part (support part) of the second joint part J2.
  • the pair of side frames 23 are connected to the upper frame 22.
  • the pair of side frames 23 is covered with a bowl-shaped cover 33.
  • a pair of side frames 23 supports a drum body 24 as a rotating portion of the second joint portion J2 that also serves as a motor housing.
  • a delivery mechanism 25 is attached to the peripheral surface of the drum body 24.
  • the delivery mechanism 25 is covered with a cylindrical cover 34.
  • a gap between the saddle-shaped cover 33 and the cylindrical cover 34 is covered with a U-shaped bellows cover 35 having a U-shaped cross section.
  • the U-shaped bellows cover 35 expands and contracts following the undulation movement of the second joint portion J2.
  • the delivery mechanism 25 holds a drive gear 56, a guide roller 57, and a roller unit 58. As the shaft of the drum body 24 rotates, the delivery mechanism 25 rotates, and the arm portion 5 supported by the delivery mechanism 25 undulates up and down.
  • the third joint portion J3 is provided by a linear motion expansion / contraction mechanism.
  • the linear motion expansion / contraction mechanism has a structure newly developed by the inventors, and is clearly distinguished from a so-called conventional linear motion joint in terms of a movable range.
  • the arm portion 5 of the third joint portion J3 is freely bendable, the bending is restricted when the arm portion 5 is fed forward along the center axis (extension / retraction center axis RA3) from the base feed mechanism 25 of the arm portion 5, and linear rigidity is obtained. Is secured. When the arm part 5 is pulled back, the bending is recovered.
  • the arm unit 5 includes a first frame row 51 and a second frame row 52.
  • the first frame row 51 is composed of a plurality of first frames 53 that are connected to be freely bent.
  • the first frame 53 is formed in a substantially flat plate shape.
  • the first frame 53 is connected to be bent at a hinge portion at an end portion.
  • the second frame row 52 includes a plurality of second frames 54.
  • the second frame 54 is configured as a cylindrical body having a U-shaped cross section or a quadrangular cross section with one surface open.
  • the second frame 54 is connected to bendable at the hinge portion at the end of the bottom plate.
  • the bending of the second frame row 52 is limited at a position where the end surfaces of the side plates of the second frame 54 come into contact with each other. At that position, the second frame row 52 is linearly arranged.
  • the first first frame 53 of the first frame sequence 51 and the second second frame 54 of the second frame sequence 52 are connected by a combined frame 55.
  • the combined frame 55 has a shape obtained by combining the first frame 53 and the second frame 54.
  • the first and second frame rows 51 and 52 are pressed against each other by the roller 59 when passing through the roller unit 58 of the feed mechanism 25. Accordingly, the first and second frame rows 51 and 52 exhibit linear rigidity and constitute the columnar arm portion 5.
  • a drive gear 56 is disposed behind the roller unit 58 together with the guide roller 57.
  • the drive gear 56 is connected to a motor unit (not shown).
  • the motor unit generates power for rotating the drive gear 56.
  • a linear gear is formed along the connecting direction at the inner surface of the first frame 53, in other words, at the center of the width of the surface in contact with the second frame 54.
  • the drive gear 56 is meshed with the linear gear of the first frame 53 pressed by the guide roller 57.
  • the linear gear connected in a straight line forms a rack and pinion mechanism together with the drive gear 56.
  • the first and second frame rows 51, 52 that have returned to the bendable state are both bent in the same direction (inner side) and stored vertically in the turning unit 2. At this time, the first frame row 51 is stored in a state of being substantially aligned with the second frame row 52 substantially in parallel.
  • the wrist part 6 is attached to the tip of the arm part 5.
  • the wrist 6 is equipped with fourth to sixth joints J4 to J6.
  • the fourth to sixth joints J4 to J6 are each provided with three orthogonal rotation axes RA4 to RA6.
  • the fourth joint portion J4 is a rotary joint centered on a fourth rotation axis RA4 that substantially coincides with the expansion / contraction center axis RA3, and the end effector is swung and rotated by the rotation of the fourth joint portion J4.
  • the fifth joint J5 is a rotary joint centered on the fifth rotation axis RA5 arranged perpendicular to the fourth rotation axis RA4, and the end effector is tilted and rotated back and forth by the rotation of the fifth joint J5.
  • the sixth joint portion J6 is a rotational joint centered on a sixth rotational axis RA6 that is disposed perpendicular to the fourth rotational axis RA4 and the fifth rotational axis RA5, and ends by the rotation of the sixth joint portion J6.
  • the effector is pivoted.
  • the fourth joint portion J4 has a cylindrical body with the rotation axis RA4 as the center line, and the cylindrical body of the fourth joint portion J4 is formed at the tip of the fourth joint portion J4 so as to be orthogonal to the center line.
  • the fixing part 61 of the fifth joint part J5 is attached.
  • a U-shaped or C-shaped arm 62 is rotatably supported by the fixed portion 61 of the fifth joint portion J5 in a shape straddling both ends.
  • a cylindrical body 63 that forms a fixed portion of the sixth joint J6 is attached to the inside of the tip of the arm 62.
  • the U-shaped arm 62 of the wrist 6 is typically equipped with the sensor body 11 of the U-shaped proximity sensor device 10 so as to cover the outer periphery thereof. It is not denied that the sensor body 11 is C-shaped.
  • the proximity sensor device 10 detects the approach when a worker (human) finger, arm, torso, or the like typically approaches the sensor body 11 as a detected body. Further, the proximity sensor device 10 detects contact when a finger (hand), an arm, a torso, etc. of an operator (human) typically comes into contact with the sensor body 11 as a detected body. Details of the proximity sensor device 10 will be described later.
  • the end effector (hand effector) is attached to an adapter 7 provided at the lower part of the rotating part of the sixth joint part J6 of the wrist part 6.
  • the end effector is a part having a function of directly acting on a work target (work) by the robot, and various tools such as a gripping part, a vacuum suction part, a nut fastener, a welding gun, and a spray gun exist.
  • the end effector is moved to an arbitrary position by the first, second, and third joint portions J1, J2, and J3, and is disposed in an arbitrary posture by the fourth, fifth, and sixth joint portions J4, J5, and J6.
  • the length of the expansion / contraction distance of the arm portion 5 of the third joint portion J3 enables the end effector to reach a wide range of objects from the proximity position of the base 1 to the remote position.
  • the third joint portion J3 is a characteristic point that is different from the conventional linear motion joint in the linear expansion / contraction operation realized by the linear motion expansion / contraction mechanism constituting the third joint portion J3 and the length of the expansion / contraction distance.
  • Fig. 4 shows the configuration of the robot arm mechanism in graphical symbols.
  • 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.
  • three posture degrees of freedom are realized by the fourth joint portion J4, the fifth joint portion J5, and the sixth joint portion J6 constituting the wrist three axes.
  • the rotation axis RA1 of the first joint portion J1 is provided in the vertical direction.
  • the rotation axis RA2 of the second joint portion J2 is provided in the horizontal direction.
  • the second joint portion J2 is offset with respect to the first joint portion J1 with respect to the two directions of the rotation axis RA1 and an axis orthogonal to the rotation axis RA1.
  • the rotation axis RA2 of the second joint portion J2 does not intersect the rotation axis RA1 of the first joint portion J1.
  • the movement axis RA3 of the third joint portion J3 is provided in a direction perpendicular to the rotation axis RA2.
  • the third joint portion J2 is offset with respect to the second joint portion J2 with respect to two directions of the rotation axis RA1 and an axis orthogonal to the rotation axis RA1.
  • the rotation axis RA3 of the third joint portion J3 does not intersect the rotation axis RA2 of the second joint portion J2.
  • One joint part of the base three axes of the plurality of joint parts J1-J6 is replaced with a linear motion expansion / contraction joint part J3, and the second joint part J2 is offset in two directions with respect to the first joint part J1,
  • the robot arm mechanism of the robot apparatus eliminates the singularity posture structurally.
  • FIG. 5A is a perspective view of the sensor main body 11 of the proximity sensor device 10, and FIG. 5B is a front view of the sensor main body 11.
  • FIG. 6 is an exploded view showing the structure of the sensor body 11.
  • 7 is a cross-sectional view of the sensor body 11 taken along the line AA in FIG.
  • FIG. 8A shows the position of the detection target P when the capacitance sensor is turned on
  • FIGS. 8 and 9 are supplementary explanatory diagrams for explaining the operation of the proximity sensor device 10.
  • FIG. 10 is a block diagram showing a configuration of the proximity sensor device 10 of FIG.
  • the proximity sensor device 10 includes a proximity sensor that detects the approach of a body to be detected such as an operator's torso, arm, and finger to the sensor body 11, and is supported by a push button switch 100 that is turned on / off according to the presence or absence of an external force.
  • the proximity sensor is a capacitance-type proximity sensor (hereinafter referred to as a capacitance sensor) having a detection electrode 16 that forms a capacitance with the object to be detected.
  • the push button switch 100 may be another mechanical switch such as a membrane switch.
  • the membrane switch is a thin sheet-like switch, and operates as a switch when a conductor attached to the operation unit side is in electrical contact with a switch circuit below the switch.
  • the push button type switch 100 is preferably a momentary operation method in which the push button type switch 100 is kept on only while an operation unit 102 described later is being pressed. Thereby, the return operation
  • the push button switch 100 may be an alternate operation method that maintains an ON state when pressed and cannot be restored to the original state unless pressed again.
  • the sensor main body 11 of the proximity sensor device 10 is a thin plate-like body curved in a U shape along the shape of the arm 62 of the wrist 6.
  • the shape of the sensor main body 11 is not limited to the U shape, and may be formed in an arbitrary shape along the shape of the target to which the sensor main body 11 is to be attached.
  • the sensor main body 11 has a shallow open box-shaped casing (case) 13 having a conductive surface curved in a U shape along the shape of the arm 62 of the wrist 6. Screw holes 12 are formed in both ends of the housing 13 for mounting on the U-shaped arm of the wrist 6.
  • On the inner surface of the bottom plate of the housing 13, a plurality of push button type switches 100 are erected at regular intervals.
  • An operation portion 102 having a cylindrical shape is inserted into the main body portion 101 so as to be movable in the axial direction.
  • the operation unit 102 is biased in a direction (biasing direction) to be pushed out from the main body 101 by a biasing means such as a spring (not shown).
  • the operation unit 102 is pushed into the main body unit 101 against the urging force.
  • the push button switch 100 is installed in the housing 13 such that the axial direction of the operation unit 102 is perpendicular to the bottom plate of the housing 13.
  • a screw hole 103 for attaching the electrode base plate 14 is formed in the distal end surface of the operation unit 102.
  • a switch unit and a switch detection circuit that detects opening and closing of the switch unit are housed in a housing.
  • the switch unit When the operation unit 102 is pushed a predetermined distance, the switch unit is closed. When the switch unit is closed, the switch detection circuit outputs a signal (referred to as an ON signal) indicating that the switch unit is closed. When the operation unit 102 is opened, the switch unit is biased in the pushing direction by the spring, and the switch unit is switched to the open state. The switch detection circuit does not output an ON signal when the switch unit is in an open state, or a signal indicating that the switch unit is in an open state (referred to as an OFF signal). Here, an OFF signal is output for convenience of explanation. .
  • an electrode base plate 14-3 on which a detection electrode 16-3 of a proximity sensor is mounted is supported by four pushbutton switches 100-1, 100-2, 100-3, 100-4.
  • the pushbutton switches 100-1, 100-2, 100-3, 100-4 are connected to the switch detection circuits 20-1, 20-2, 20-3, 20-4, respectively.
  • the switch detection circuit 20 outputs an on / off signal according to the opening / closing of the switch unit. For example, when the operation unit 102 is pushed in and the switch unit is closed, the switch detection circuit outputs an ON signal indicating that the pushbutton switch 100 is turned on.
  • the on / off signal output from the switch detection circuit 20 is sent to the control unit of the robot apparatus, for example.
  • the control unit of the robot apparatus executes emergency stop control for stopping, for example, the robot arm mechanism when receiving an ON signal indicating that the pushbutton switch is turned ON.
  • the sensor body 11 has electrode base plates 14-1, 14-2, 14-3.
  • the electrode base plates 14-1, 14-2, 14-3 are formed and arranged so as to form a U-shape as a whole.
  • the electrode base plate 14-1 is C-shaped.
  • the two electrode base plates 14-2 and 14-3 have a flat plate shape.
  • the electrode base plates 14-1, 14-2, and 14-3 are formed of a nonconductive material such as a hard resin as a nonconductor (insulator).
  • Detection electrodes 16-1, 16-2, and 16-3 (collectively referred to as detection electrodes 16) of capacitance sensors are attached to the electrode base plates 14-1, 14-2, and 14-3, respectively. .
  • the detection electrode 16 is a film-like conductor, and is attached to the front surface of the electrode base plate 14 in accordance with the front shape of the electrode base plate 14.
  • the electrode base plate 14 is provided with a screw hole 15 for mounting on the operation unit 102 of the pushbutton switch 100.
  • the electrode base plates 14-1, 14-2, and 14-3 on which the detection electrodes 16-1, 16-2, and 16-3 are mounted are attached to the operation units 102 of the plurality of pushbutton switches 100 by screws 200, respectively. And covered with hard resin covers 17-1, 17-2, 17-3 shaped along the front surface of the base.
  • the detection electrode 16 forms a capacitance between the detection electrode 16 and a detection object P as a ground conductor such as a finger of an approaching worker.
  • a capacitance detection circuit 18 is connected to the detection electrode 16.
  • the capacitance detection circuit 18 detects a capacitance (anti-ground capacitance) C formed between the detection target P and the detection electrode 16 by, for example, a switched capacitor operation.
  • the determination unit 19 determines the approach of the detection target P to the detection electrode 16 from the change in the capacitance C detected by the capacitance detection circuit 18.
  • the capacitance C is small when the detection target P does not exist within the sensitivity region, and increases when the detection target P exists within the sensitivity region.
  • the determination unit 19 determines the approach of the detected object P when the electrostatic capacitance C becomes equal to or greater than a predetermined value, and outputs an approach signal indicating the approach of the detected object P.
  • the approach signal output from the determination part 19 is sent to the control part of a robot apparatus, for example.
  • the control unit of the robot apparatus executes emergency stop control for stopping the robot arm mechanism, for example, when receiving an approach signal indicating that the detected object P has approached the sensor body.
  • the proximity sensor device 10 according to the present embodiment configured as described above detects that the detection target P has approached the sensor main body 11 using a capacitance sensor, As shown in FIG. 8B, it is possible to detect with the pushbutton switch 100 that the detected object P has contacted the sensor main body 11 (cover 17). That is, the proximity sensor device 10 according to the present embodiment has both a proximity sensor function and a contact sensor function, thereby detecting both the approach and contact of the detected object P to the sensor body 11. it can.
  • the safety function can be activated in two stages, that is, the stage in which the detected object P approaches and the stage in contact.
  • the robot apparatus can stop the robot arm mechanism, for example. Even if the approach of the worker to the sensor main body 11 cannot be detected due to a failure of the capacitance sensor of the proximity sensor device 10 or the like, the robot device can detect the sensor by the push button switch 100 of the proximity sensor device 10. When the contact of the worker with the main body 11 is detected, for example, the robot arm mechanism can be stopped. That is, the robot apparatus can stop the robot arm mechanism at least when the worker contacts the sensor main body 11.
  • the push button type switch 100 has a detection method different from that of the capacitance sensor, and is turned on / off by a physical pressing operation of the operation unit 102. Therefore, the push button type switch 100 is less affected by the surrounding environment than the capacitance sensor. Its reliability is high. Therefore, the proximity sensor device 10 according to the present embodiment can improve the reliability as compared with the conventional proximity sensor by configuring the sensor that operates in the unlikely event of the push button switch 100.
  • the configuration of the proximity sensor device 10 according to the present embodiment supports the conventional proximity sensor with the pushbutton switch 100, the versatility is high.
  • the pushbutton switch 100 also serves as a support member that supports the proximity sensor, the proximity sensor device 10 can be configured without greatly changing the width and length of the conventional proximity sensor.
  • control unit of the robot apparatus may execute different processes depending on whether the ON signal of the capacitance sensor is received and when the ON signal of the pushbutton switch 100 is received.
  • control unit of the robot apparatus may execute the speed reduction control for reducing the operation speed of the robot arm mechanism when receiving the ON signal of the capacitance sensor.
  • the robot apparatus is compared with a case where the robot arm mechanism is stopped each time the worker approaches the sensor main body 11. It is possible to suppress a decrease in operating efficiency.
  • the robot arm mechanism operates at a low speed when the worker approaches the sensor body 11, even if the robot arm mechanism collides with the worker, the impact of the robot arm mechanism is normal. It is small compared to the case where the robot apparatus is installed, and the safety of the robot apparatus can be maintained.
  • the switch detection circuit 20 is connected to each of the plurality of pushbutton switches 100 that support the electrode base plate 14 on which the detection electrodes 16 are mounted.
  • the controller of the robot apparatus can execute an emergency stop process of the robot arm mechanism. That is, as shown in FIG. 9A, for example, even when the electrode base plate 14-3 on which the detection electrode 16-3 is mounted is tilted and pressed, as shown in FIG. 17-3 and the electrode base plate 14-3 are molded of a soft resin, and the controller of the robot apparatus performs emergency stop processing of the robot arm mechanism even when the cover 17-3 is partially pressed. Can be executed.
  • FIG. 11 is a diagram illustrating the structure of the proximity sensor device 10 according to a modification of the present embodiment.
  • the pressure sensor has a sheet-shaped piezoelectric sheet (polymer thick-film film or the like) 300.
  • the piezoelectric sheet 300 outputs a voltage signal corresponding to the electric resistance value to the determination circuit of the pressure sensor.
  • the determination circuit detects the contact of the detected body with the sensor main body 11 when the voltage value sent from the piezoelectric sheet 300 becomes a predetermined value or more.
  • the piezoelectric sheet 300 is adhered to the inner surface of the bottom plate of the housing 13. Further, the rear end surface of the cylindrical rigid column 302 is attached to the surface of the piezoelectric sheet 300 with an adhesive or the like.
  • a metal screw hole 303 is attached to the front end surface of the support post 302. As shown in FIG. 11, for example, the electrode base plate 14 on which the detection electrode 16 is mounted is mounted with the screw 200 in a state where the screw hole 15 is aligned with the screw hole 303 of the column 302. An external force applied to the cover 17 (electrode base plate 14) presses the piezoelectric sheet 300 via the support column 302. An ON signal is output when pressure is applied to the piezoelectric sheet 300.
  • the electrode base plate 14 on which the detection electrode 16 is mounted is supported by the piezoelectric sheet 300, so that the detection target approaches and contacts the sensor main body 11. Both can be detected, and the reliability can be improved as compared with the conventional proximity sensor.
  • a photoelectric sensor device can be used as a sensor that turns on and off according to the presence or absence of external force.
  • the photoelectric sensor device has a light projecting unit and a light receiving unit.
  • the light projecting unit and the light receiving unit are disposed to face the bottom surface of the housing 13.
  • the light projecting section and the light receiving section are covered with a buffer material that transmits light, such as urethane sponge, including the optical path.
  • the electrode base plate 14 to which the detection electrode 16 is attached is attached to the urethane sponge with a screw, an adhesive or the like.
  • the light receiving unit outputs a voltage signal corresponding to the amount of received light to the determination circuit.
  • the amount of light received by the light receiving portion is lower than when no external force is applied to the urethane sponge.
  • the determination circuit detects the contact of the detected body with the sensor main body 11 when the voltage value sent from the light receiving unit becomes a predetermined value or less. In this way, by supporting the electrode base plate 14 on which the detection electrode 16 is mounted by the photoelectric sensor device, it is possible to detect both the approach and contact of the detection target to the sensor body 11, and the conventional proximity sensor The reliability can be improved compared to the above.
  • the push button type switch 100 is erected on the bottom surface (front surface) of the casing 13 of the sensor body 11, and the electrode base plates 14-1, 14-2, and 14-3 are directly pushed.
  • the U-shaped sensor main body 11 may be supported by the push button switch 100. That is, the push button type switch 100 may be erected on the outer periphery of the arm 62 and the sensor body 11 may be supported by the push button type switch 100. In this case, the electrode base plates 14-1, 14-2, 14-3 are indirectly supported by the push button type switch 100.
  • SYMBOLS 10 Proximity sensor apparatus, 11 ... Sensor main body, 12 ... Screw hole, 13 ... Housing, 14-1, 14-2, 14-3 ... Electrode base plate, 15 ... Screw hole, 16-1, 16-2, 16-3... Detection electrode, 17-1, 17-2, 17-3... Cover, 100.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Manipulator (AREA)
  • Switches That Are Operated By Magnetic Or Electric Fields (AREA)

Abstract

目的は、シンプルな構成にして、近接とともに接触を検知することのできる近接センサ装置を提供することである。 本実施形態に係る近接センサ装置10は、被検出体との間に静電容量を形成する検出電極16を有する。検出電極16は電極ベース板14に装着される。検出部18は、検出電極16の出力に基づいて、静電容量を検出する。電極ベース板14は押ボタン型スイッチ100に支持される。被検出体が検出電極16に接近したとき、静電容量が変化する。静電容量の変化により被検出体の接近を検知することができる。被検出体が検出電極16に接触したとき、押ボタン型スイッチ10がオンする。押ボタン型スイッチ10のオンにより被検出体の接触を検知することができる。

Description

近接センサ装置及びロボットアーム機構
 本発明の実施形態は近接センサ装置及びロボットアーム機構に関する。
 従来から多関節ロボットアーム機構が産業用ロボットなど様々な分野で用いられている。発明者らが実用化した直動伸縮機構は、垂直多関節形のロボットアーム機構から肘関節を不要とさせることができ、安全柵を不要として作業員の近傍へロボットを設置することが可能となり、ロボットと作業員とが協働する環境が現実的となった。
 その一方でロボットアーム機構が作業員の近傍に配置されるため高い安全性の確保が重要である。高い安全性の確保のために、近接センサ装置を装備し、その近接センサ装置の出力に従って緊急停止等のロボットアーム機構の制御を行うものがある。故障、その他の要因により、近接を検知できない場合がある。その場合、作業員等は近接センサ装置に接触してしまう。そのためにロボットアーム機構に近接センサとは別に接触センサを装備させる必要があった。
特許第5435679号公報
 目的は、シンプルな構成にして近接とともに接触を検知することのできる近接センサ装置を提供することにある。
 本実施形態に係る近接センサ装置は、被検出体との間に静電容量を形成する検出電極と、前記検出電極を装着するベース板と、前記静電容量を検出する検出部とを具備し、前記ベース板は押ボタン型スイッチ又は圧力センサに支持されることを特徴とする。
図1は、本実施形態に係るロボットアーム機構の外観を示す斜視図である。 図2は、図1のロボットアーム機構の側面図である。 図3は、図1のロボットアーム機構の内部構成を示す図である。 図4は、図1のロボットアーム機構の構成を図記号表現により示す図である。 図5は、図1の近接センサ装置のセンサ本体を示す図である。 図6は、図5のセンサ本体の内部構造を示す分解図である。 図7は、図5のセンサ本体のA-A断面図である。 図8は、図5の近接センサ装置の動作を説明するための第1補足説明図である。 図9は、図5の近接センサ装置の動作を説明するための第2補足説明図である。 図10は、図1の近接センサ装置の構成を示す図である。 図11は、図1の近接センサ装置の他の構造を示す図である。
 以下、図面を参照しながら本実施形態に係る近接センサ装置を説明する。本実施形態に係る近接センサ装置は典型的にはロボットアーム機構に装備される。しかしながら、近接センサ装置は、単独の装置として他の装置等に使用することができる。以下の説明では、本実施形態に係る近接センサ装置を装備するロボットアーム機構を例に説明する。このロボットアーム機構は、複数の関節部のうち一の関節部が直動伸縮機構で構成されている。ここでは直動伸縮機構を備えたロボットアーム機構をするが、本実施形態に係る近接センサ装置は他のタイプのロボットアーム機構に対しても装備することができる。以下の説明において、略同一の機能及び構成を有する構成要素については、同一符号を付し、重複説明は必要な場合にのみ行う。
 図1は本実施形態に係る近接センサ装置を装備するロボットアーム機構の外観を示している。図2は、図1のロボットアーム機構の側面図である。図3は、図1のロボットアーム機構の内部構造を示す側面図である。 
 ロボットアーム機構は、基台1、旋回部2、起伏部4、アーム部5及び手首部6を備える。旋回部2、起伏部4、アーム部5及び手首部6は、基台1から順番に配設される。複数の関節部J1,J2,J3,J4,J5,J6は基台1から順番に配設される。基台1には円筒体をなす旋回部2が典型的には鉛直に設置される。旋回部2は旋回回転関節部としての第1関節部J1を収容する。第1関節部J1は回転軸RA1を備える。回転軸RA1は鉛直方向に平行である。旋回部2は下部フレーム21と上部フレーム22とを有する。下部フレーム21の一端は第1関節部J1の固定部が接続される。下部フレーム21の他端は基台1に接続される。下部フレーム21は円筒形状のハウジング31により覆われる。上部フレーム22は第1関節部J1の回転部に接続され、回転軸RA1を中心に軸回転する。上部フレーム22は円筒形状のハウジング32により覆われる。第1関節部J1の回転に伴って下部フレーム21に対して上部フレーム22が回転し、それによりアーム部5は水平に旋回する。円筒体をなす旋回部2の内部中空には後述する直動伸縮機構としての第3関節部J3の第1、第2コマ列51、52が収納される。
 旋回部2の上部には起伏回転関節部としての第2関節部J2を収容する起伏部4が設置される。第2関節部J2は回転関節である。第2関節部J2の回転軸RA2は回転軸RA1に垂直である。起伏部4は、第2関節部J2の固定部(支持部)としての一対のサイドフレーム23を有する。一対のサイドフレーム23は、上部フレーム22に連結される。一対のサイドフレーム23は、鞍形形状のカバー33により覆われる。一対のサイドフレーム23にモータハウジングを兼用する第2関節部J2の回転部としてのドラム体24が支持される。ドラム体24の周面には、送り出し機構25が取り付けられる。送り出し機構25は円筒形状のカバー34により覆われる。鞍形カバー33と円筒カバー34との間の間隙は断面U字形状のU字蛇腹カバー35により覆われる。U字蛇腹カバー35は、第2関節部J2の起伏動に追従して伸縮する。送り出し機構25は、ドライブギア56、ガイドローラ57及びローラユニット58を保持する。ドラム体24の軸回転に伴って送り出し機構25は回動し、送り出し機構25に支持されたアーム部5が上下に起伏する。
 第3関節部J3は直動伸縮機構により提供される。直動伸縮機構は発明者らが新規に開発した構造を備えており、可動範囲の観点でいわゆる従来の直動関節とは明確に区別される。第3関節部J3のアーム部5は屈曲自在であるが、中心軸(伸縮中心軸RA3)に沿ってアーム部5の根元の送り出し機構25から前方に送り出されるときには屈曲が制限され、直線的剛性が確保される。アーム部5は後方に引き戻されるときには屈曲が回復される。アーム部5は第1コマ列51と第2コマ列52とを有する。第1コマ列51は屈曲自在に連結された複数の第1コマ53からなる。第1コマ53は略平板形に構成される。第1コマ53は端部箇所のヒンジ部で屈曲自在に連結される。第2コマ列52は複数の第2コマ54からなる。第2コマ54は例えば一面が開いた断面U字形状又は断面四角形状の筒体に構成される。第2コマ54は底板端部箇所のヒンジ部で屈曲自在に連結される。第2コマ列52の屈曲は、第2コマ54の側板の端面どうしが当接する位置で制限される。その位置では第2コマ列52は直線的に配列する。第1コマ列51の先頭の第1コマ53と、第2コマ列52の先頭の第2コマ54とは結合コマ55により接続される。例えば、結合コマ55は第1コマ53と第2コマ54とを合成した形状を有している。
 第1、第2コマ列51,52は送り出し機構25のローラユニット58を通過する際にローラ59により互いに押圧されて互いに接する。それにより第1、第2コマ列51,52は直線的剛性を発揮し、柱状のアーム部5を構成する。ローラユニット58の後方にはドライブギア56がガイドローラ57とともに配置される。ドライブギア56は図示しないモータユニットに接続される。モータユニットは、ドライブギア56を回転させるための動力を発生する。後述するが、第1コマ53の内側の面、換言すると、第2コマ54と接する側の面の幅中央には連結方向に沿ってリニアギアが形成されている。複数の第1コマ53が直線状に整列されたときに隣合うリニアギアは直線状につながって、長いリニアギアを構成する。ドライブギア56はガイドローラ57に押圧された第1コマ53のリニアギアに噛み合わされる。直線状につながったリニアギアはドライブギア56とともにラックアンドピニオン機構を構成する。ドライブギア56が順回転するとき第1、第2コマ列51,52はローラユニット58から前方に送り出される。ドライブギア56が逆回転するとき第1、第2コマ列51,52はローラユニット58の後方に引き戻される。引き戻された第1、第2コマ列51,52はローラユニット58とドライブギア56との間で分離される。分離された第1、第2コマ列51,52はそれぞれ屈曲可能な状態に復帰する。屈曲可能な状態に復帰した第1、第2コマ列51,52は、ともに同じ方向(内側)に屈曲し、旋回部2の内部に鉛直に収納される。このとき、第1コマ列51は第2コマ列52に略平行にほぼ揃った状態で収納される。
 アーム部5の先端には手首部6が取り付けられる。手首部6は第4~第6関節部J4~J6を装備する。第4~第6関節部J4~J6はそれぞれ直交3軸の回転軸RA4~RA6を備える。第4関節部J4は伸縮中心軸RA3と略一致する第4回転軸RA4を中心とした回転関節であり、この第4関節部J4の回転によりエンドエフェクタは揺動回転される。第5関節部J5は第4回転軸RA4に対して垂直に配置される第5回転軸RA5を中心とした回転関節であり、この第5関節部J5の回転によりエンドエフェクタは前後に傾動回転される。第6関節部J6は第4回転軸RA4と第5回転軸RA5とに対して垂直に配置される第6回転軸RA6を中心とした回転関節であり、この第6関節部J6の回転によりエンドエフェクタは軸回転される。
 第4関節部J4は、回転軸RA4を中心線とする円筒体をなしており、この第4関節部J4の先端に第4関節部J4の円筒体と中心線が直交するよう円筒体をなす第5関節部J5の固定部61が取り付けられる。第5関節部J5の固定部61にはその両端を跨いた状体でU字形又はC字形のアーム62が回転自在に支持される。このアーム62の先端内側には第6関節部J6の固定部をなす円筒体63が取り付けられる。
 手首部6のU字形のアーム62にはその外周を覆うように典型的にはU字形の近接センサ装置10のセンサ本体11が装備される。なおセンサ本体11はC字形であることは否定されない。近接センサ装置10は、そのセンサ本体11に被検出体として典型的には作業員(人間)の指、腕、胴体等が接近したとき、その接近を検出する。また、近接センサ装置10は、そのセンサ本体11に被検出体として典型的には作業員(人間)の指、腕、胴体等が接触したとき、その接触を検出する。近接センサ装置10の詳細は後述する。
 エンドエフェクタ(手先効果器)は、手首部6の第6関節部J6の回転部下部に設けられたアダプタ7に取り付けられる。エンドエフェクタはロボットが作業対象(ワーク)に直接働きかける機能を持つ部分であり、例えば把持部、真空吸着部、ナット締め具、溶接ガン、スプレーガンなどのタスクに応じて様々なツールが存在する。エンドエフェクタは、第1、第2、第3関節部J1,J2,J3により任意位置に移動され、第4、第5、第6関節部J4,J5,J6により任意姿勢に配置される。特に第3関節部J3のアーム部5の伸縮距離の長さは、基台1の近接位置から遠隔位置までの広範囲の対象にエンドエフェクタを到達させることを可能にする。第3関節部J3はそれを構成する直動伸縮機構により実現される直線的な伸縮動作とその伸縮距離の長さとが従前の直動関節と異なる特徴的な点である。
 図4はロボットアーム機構の構成を図記号表現により示している。ロボットアーム機構において、根元3軸を構成する第1関節部J1と第2関節部J2と第3関節部J3とにより3つの位置自由度が実現される。また、手首3軸を構成する第4関節部J4と第5関節部J5と第6関節部J6とにより3つの姿勢自由度が実現される。図4に示すように、第1関節部J1の回転軸RA1は鉛直方向に設けられる。第2関節部J2の回転軸RA2は水平方向に設けられる。第2関節部J2は第1関節部J1に対して回転軸RA1と回転軸RA1に直交する軸との2方向に関してオフセットされる。第2関節部J2の回転軸RA2は、第1関節部J1の回転軸RA1には交差しない。第3関節部J3の移動軸RA3は回転軸RA2に対して垂直な向きに設けられる。第3関節部J2は第2関節部J2に対して回転軸RA1と回転軸RA1に直交する軸との2方向に関してオフセットされる。第3関節部J3の回転軸RA3は、第2関節部J2の回転軸RA2には交差しない。複数の関節部J1-J6の根元3軸のうちの一つの関節部を直動伸縮関節部J3に換装し、第1関節部J1に対して第2関節部J2を2方向にオフセットさせ、第2関節部J2に対して第3関節部J3を2方向にオフセットさせることにより、本実施形態に係るロボット装置のロボットアーム機構は、特異点姿勢を構造上解消している。
 図5(a)は近接センサ装置10のセンサ本体11の斜視図、図5(b)はセンサ本体11の正面図である。図6はセンサ本体11の構造を示す分解図である。図7は図5のセンサ本体11のA-A断面図である。図8(a)は静電容量センサがオンするときの被検出体Pの位置を示し、図8、図9は、近接センサ装置10の動作を説明するための補足説明図である。図10は図1の近接センサ装置10の構成を示すブロック図である。
 近接センサ装置10は作業員の胴体、腕、手指等の被検出体のセンサ本体11への接近を検出する近接センサが、外力の有無に従ってオン・オフする押しボタン型スイッチ100に支持されてなる。ここでは、近接センサは、被検出体との間に静電容量を形成する検出電極16を有する静電容量型の近接センサ(以下、静電容量センサと称す)である。
 なお、押ボタン型スイッチ100は、他の機械式スイッチ、例えばメンブレンスイッチでもよい。メンブレンスイッチは、シート状の薄いスイッチである、操作部側に取り付けた導体が、その下部のスイッチ回路に電気的に接することでスイッチとして動作する。押ボタン型スイッチ100は好適には後述の操作部102が押下されている間だけオン状態を維持するモーメンタリ動作方式である。これにより、押下した押ボタン型スイッチ100を元の状態に戻す復帰動作が不要とすることができる。なお、押ボタン型スイッチ100は押下したらオン状態を保持し、もう一度押下しなければ元の状態に戻すことができないオルタネイト動作方式であってもよい。
 近接センサ装置10のセンサ本体11は手首部6のアーム62の形状に沿ってU字形に湾曲された薄い板状体である。センサ本体11の形状はU字形に限定されず、センサ本体11を装着する対象の形状に沿って任意の形状に形成され得る。センサ本体11は、手首部6のアーム62の形状に沿ってU字形に湾曲された導電性を有する一面が開放された浅いオープンボックス形の筐体(ケース)13を有する。筐体13の両端それぞれには手首部6のU字形のアームに装着するためのネジ孔12があけられている。筐体13の底板の内面には複数の押ボタン型スイッチ100が一定の間隔を隔てて立設される。
 本体部101には、円柱形状を有する操作部102がその軸方向に移動可能に挿入されている。操作部102は図示しないバネ等の付勢手段により本体部101から押し出される方向(付勢方向)に付勢されている。操作部102は付勢力に抗って本体部101に押し込まれる。押ボタン型スイッチ100は操作部102の軸方向が筐体13の底板に垂直になるように筐体13に設置される。操作部102の先端面には、電極ベース板14を取り付けるためのネジ孔103が空けられている。本体部101には、スイッチ部とスイッチ部の開閉を検出するスイッチ検出回路とが筐体に収容されている。操作部102が所定距離を押し込まれるときスイッチ部は閉じる。スイッチ検出回路は、スイッチ部が閉じたとき、スイッチ部が閉じたことを表す信号(オン信号という)を出力する。操作部102が開放されたときバネにより押し出す方向に付勢され、スイッチ部は開状態に切り替わる。スイッチ検出回路は、スイッチ部が開状態のとき、オン信号を出力しない、またはスイッチ部が開状態であることを表す信号(オフ信号という)ここでは説明の便宜上オフ信号が出力されるものとする。
 図10に示すように、近接センサの検出電極16-3が装着された電極ベース板14-3が4つの押ボタン型スイッチ100-1,100-2,100-3,100-4で支持されている場合、押ボタン型スイッチ100-1,100-2,100-3,100-4のそれぞれがスイッチ検出回路20-1,20-2,20-3,20-4に接続される。スイッチ検出回路20は、スイッチ部の開閉に応じたオン・オフ信号を出力する。例えば、操作部102が押し込まれ、スイッチ部が閉じたとき、スイッチ検出回路は押ボタン型スイッチ100がオンしたことを示すオン信号を出力する。スイッチ検出回路20から出力されたオン・オフ信号は、例えばロボット装置の制御部に送られる。ロボット装置の制御部は、押ボタン型スイッチがオンしたことを示すオン信号を受信したのを契機に、例えばロボットアーム機構を停止する緊急停止制御を実行する。
 センサ本体11は電極ベース板14-1,14-2,14-3を有する。電極ベース板14-1,14-2,14-3は、全体としてU字形をなすように成形され、配置されている。電極ベース板14-1はC字形をなす。二つの電極ベース板14-2,14-3は平板形をなす。電極ベース板14-1,14-2,14-3は不導体(絶縁体)として硬質樹脂などの非導電性材料で成形されている。これら電極ベース板14-1,14-2,14-3のそれぞれには静電容量センサの検出電極16-1,16-2,16-3(まとめて検出電極16と称する)が装着される。例えば検出電極16はフィルム状の導体であり、電極ベース板14の前面に、電極ベース板14の前面形状に合わせて貼り付けられている。電極ベース板14には押ボタン型スイッチ100の操作部102に装着するためのネジ孔15があけられている。検出電極16-1,16-2,16-3が装着された電極ベース板14-1,14-2,14-3は、それぞれネジ200により複数の押ボタン型スイッチ100の操作部102に取り付けられ、ベースの前面に沿った形状の硬質樹脂製のカバー17-1,17-2,17-3により覆われる。
 図10に示すように、検出電極16は接近した作業員の指等の接地導体としての被検出体Pとの間に静電容量を形成する。検出電極16には容量検出回路18が接続されている。容量検出回路18は、被検出体Pと検出電極16との間に形成された静電容量(対接地容量)Cを、例えばスイッチドキャパシタ動作により検出する。判定部19は容量検出回路18で検出された静電容量Cの変化から被検出体Pの検出電極16への接近を判定する。静電容量Cは感度領域内に被検出体Pが存在しない状態では小さく、感度領域内に被検出体Pが存在する状態では増大する。判定部19は静電容量Cが所定の値以上になることにより、被検出体Pの接近を判定し、被検出体Pの接近を表す接近信号を出力する。判定部19から出力された接近信号は、例えばロボット装置の制御部に送られる。ロボット装置の制御部は、センサ本体に被検出体Pが接近したことを示す接近信号を受信したのを契機に、例えばロボットアーム機構を停止する緊急停止制御を実行する。
 上述のように構成された本実施形態に係る近接センサ装置10は、図8(a)に示すように、被検出体Pがセンサ本体11に接近したことを静電容量センサによりで検出し、図8(b)に示すように、被検出体Pがセンサ本体11(カバー17)に接触したことを押ボタン型スイッチ100で検出することができる。すなわち、本実施形態に係る近接センサ装置10は、近接センサ機能と接触センサ機能とを兼用してなり、それによりセンサ本体11への被検出体Pの接近と接触との両方を検出することができる。本実施形態に係る近接センサ装置10がロボット装置に装備されたとき、被検出体Pが接近した段階と接触した段階との2段階で安全機能を発動させることができる。ロボット装置は、近接センサ装置10の静電容量センサによりセンサ本体11(ロボットアーム機構)への作業員の接近が検知されたとき、例えばロボットアーム機構を停止させることができる。万が一、近接センサ装置10の静電容量センサの故障等により、センサ本体11への作業員の接近を検知できない状態であっても、ロボット装置は、近接センサ装置10の押ボタン型スイッチ100によりセンサ本体11への作業員の接触が検知されたとき、例えばロボットアーム機構を停止させることができる。すなわち、ロボット装置は、少なくとも作業員がセンサ本体11に接触したときに、ロボットアーム機構を停止させることができる。
 また、押ボタン型スイッチ100は、静電容量センサと検出方式が異なり、操作部102の物理的な押下操作によりオン/オフするため、静電容量センサに比べて周囲環境の影響を受けにくく、その信頼性が高い。したがって、本実施形態に係る近接センサ装置10は、万が一の場合に動作するセンサを押ボタン型スイッチ100で構成することで、従来の近接センサに比べて、信頼性を向上させることができる。
 また、本実施形態に係る近接センサ装置10の構成は、従来の近接センサを押ボタン型スイッチ100で支持するものであるため、汎用性が高い。特に、押ボタン型スイッチ100は、近接センサを支持する支持部材を兼用するため、従来の近接センサの幅と長さとを大きく変化させることなく、近接センサ装置10を構成することができる。
 なお、ロボット装置の制御部は、静電容量センサのオン信号を受信した時と、押ボタン型スイッチ100のオン信号を受信した時とで異なる処理を実行してもよい。例えば、ロボット装置の制御部は、静電容量センサのオン信号を受信したのを契機に、ロボットアーム機構の動作速度を遅くする低速化制御を実行するようにしてもよい。これにより、作業員がセンサ本体11に接近した状態でも、ロボットアーム機構は低速で動いているため、作業員がセンサ本体11に接近する度にロボットアーム機構を停止させる場合に比べて、ロボット装置の稼働効率の低下を抑制することができる。また、作業員がセンサ本体11に接近した状態において、ロボットアーム機構は低速で動作しているため、万が一作業員にロボットアーム機構が衝突した場合でも、その衝撃はロボットアーム機構が通常動作している場合に比べて小さく、ロボット装置の安全性を維持できる。
 また、本実施形態に係る近接センサ装置10は、検出電極16を装着する電極ベース板14を支持する複数の押ボタン型スイッチ100のそれぞれにスイッチ検出回路20が接続されているため、少なくとも一つの押ボタン型スイッチ100がオン信号を出力したとき、ロボット装置の制御部は、ロボットアーム機構の緊急停止処理を実行することができる。すなわち、図9(a)に示すように、例えば検出電極16-3を装着する電極ベース板14-3が傾いて押下された場合であっても、図9(b)に示すように、カバー17-3と電極ベース板14-3とが軟質樹脂で成形され、カバー17-3が部分的に押下された場合であっても、ロボット装置の制御部は、ロボットアーム機構の緊急停止処理を実行することができる。
 なお、押ボタン型スイッチ100は、圧力センサに代替され得る。図11は、本実施形態の変形例に係る近接センサ装置10の構造を示す図である。変形例に係る近接センサ装置は、検出電極16を装着する電極ベース板14が圧力センサを挟んで筐体13の底板に支持されてなる。図11に示すように、圧力センサはシート形状の圧電シート(高分子厚幕フィルムなど)300を有する。圧電シート300に外力が加わると、シートが変形し、その部分の電気抵抗値が変化する。圧電シート300は、電気抵抗値に応じた電圧信号を圧力センサの判定回路に出力する。判定回路は、圧電シート300から送られた電圧値が所定の値以上になることにより、センサ本体11への被検出体の接触を検出する。
 圧電シート300は、筐体13の底板の内面に貼着されている。さらに圧電シート300の表面には、円柱形の剛体支柱302の後端面が接着剤等で貼着されている。支柱302の先端面には金属製のネジ孔303が装着されている。図11に示すように、例えば検出電極16を装着する電極ベース板14は、そのネジ孔15を支柱302のネジ孔303に位置合わせした状態で、ネジ200により装着される。カバー17(電極ベース板14)にかかる外力が支柱302を介して圧電シート300を圧する。圧電シート300に圧力がかかったときオン信号が出力される。
 上述のように、変形例に係る近接センサ装置10によれば、検出電極16を装着する電極ベース板14を圧電シート300で支持することで、センサ本体11への被検出体の接近と接触との両方を検出することができ、従来の近接センサに比べて信頼性を向上させることができる。
 他にも、外力の有無に従ってオン・オフするセンサとして、例えば光電センサ装置を用いることができる。光電センサ装置は投光部と受光部とを有する。投光部と受光部とは筐体13の底面に対向して配置される。投光部と受光部とは、その光路も含めてウレタンスポンジ等の光を透過する緩衝材により覆われる。検出電極16を装着した電極ベース板14は、このウレタンスポンジにネジ、接着剤等で装着される。受光部は受光量に応じた電圧信号を判定回路に出力する。ウレタンスポンジに外力が加わると、ウレタンスポンジの密度が高くなる。それにより、受光部で受光する光量は、ウレタンスポンジに外力がかかっていないときに比べて低下する。判定回路は受光部から送られた電圧値が所定の値以下になることにより、センサ本体11への被検出体の接触を検出する。このように、検出電極16を装着する電極ベース板14を光電センサ装置で支持することで、センサ本体11への被検出体の接近と接触との両方を検出することができ、従来の近接センサに比べて信頼性を向上させることができる。
 なお、上述では、押しボタン型スイッチ100をセンサ本体11の筐体13の底面(表面)に立設し、電極ベース板14-1、14-2,14-3を直接的に押しボタン型スイッチ100で筐体13上に支持したが、U字形のセンサ本体11を押しボタン型スイッチ100で支持するようにしてもよい。つまり、押しボタン型スイッチ100をアーム62の外周に立設し、押しボタン型スイッチ100にセンサ本体11を支持ようにしてもよい。この場合、電極ベース板14-1、14-2,14-3は間接的に押しボタン型スイッチ100で支持される。
 本発明のいくつかの実施形態を説明したが、これらの実施形態は、例として提示したものであり、発明の範囲を限定することは意図していない。これら実施形態は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、変更を行うことができる。これら実施形態やその変形は、発明の範囲や要旨に含まれると同様に、特許請求の範囲に記載された発明とその均等の範囲に含まれるものである。
 10…近接センサ装置、11…センサ本体、12…ネジ孔、13…筐体、14-1,14-2,14-3…電極ベース板、15…ネジ孔、16-1,16-2,16-3…検出電極、17-1,17-2,17-3…カバー、100…押ボタン型スイッチ。

Claims (5)

  1.  被検出体との間に静電容量を形成する検出電極と、
     前記検出電極を装着するベース板と、
     前記静電容量を検出する検出部とを具備し、
     前記ベース板は押ボタン型スイッチ又は圧力センサに支持されることを特徴とする近接センサ装置。
  2.  前記押ボタン型スイッチの動作方式は、モーメンタリ動作方式であることを特徴とする請求項1記載の近接センサ装置。
  3.  前記ベース板は可撓性を有することを特徴とする請求項1記載の近接センサ装置。
  4.  前記ベース板は複数の押ボタン型スイッチ又は圧力センサにより支持されることを特徴とする請求項1記載の近接センサ装置。
  5.  基台に旋回回転関節部を備えた支柱部が支持され、前記支柱部上には起伏回転関節部を備えた起伏部が載置され、前記起伏部には直動伸縮性のアーム部を備えた直動伸縮機構が設けられ、前記アーム部の先端にはエンドエフェクタを装着可能な手首部が装備されてなるロボットアーム機構において、
     前記手首部には、近接センサ装置が装備され、
     前記近接センサ装置は、
     被検出体との間に静電容量を形成する検出電極と、
     前記検出電極を装着するベース板と、
     前記静電容量を検出する検出部とを備え、
     前記ベース板は押ボタン型スイッチ又は圧力センサに支持されることを特徴とするロボットアーム機構。
PCT/JP2017/039101 2016-10-31 2017-10-30 近接センサ装置及びロボットアーム機構 WO2018079771A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN201780063557.1A CN109844894B (zh) 2016-10-31 2017-10-30 接近传感器装置及机械臂机构
DE112017005497.4T DE112017005497T5 (de) 2016-10-31 2017-10-30 Näherungssensorvorrichtung und roboterarmmechanismus
JP2018547821A JP6829264B2 (ja) 2016-10-31 2017-10-30 近接センサ装置及びロボットアーム機構
US16/393,700 US11407121B2 (en) 2016-10-31 2019-04-24 Proximity sensor apparatus and robot arm mechanism

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2016-213924 2016-10-31
JP2016213924 2016-10-31

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US16/393,700 Continuation US11407121B2 (en) 2016-10-31 2019-04-24 Proximity sensor apparatus and robot arm mechanism

Publications (1)

Publication Number Publication Date
WO2018079771A1 true WO2018079771A1 (ja) 2018-05-03

Family

ID=62025049

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2017/039101 WO2018079771A1 (ja) 2016-10-31 2017-10-30 近接センサ装置及びロボットアーム機構

Country Status (5)

Country Link
US (1) US11407121B2 (ja)
JP (1) JP6829264B2 (ja)
CN (1) CN109844894B (ja)
DE (1) DE112017005497T5 (ja)
WO (1) WO2018079771A1 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113874178A (zh) * 2019-06-06 2021-12-31 欧姆龙株式会社 触觉传感器、机械手以及机器人
WO2022070712A1 (ja) * 2020-10-01 2022-04-07 パナソニックIpマネジメント株式会社 近接センサ、制御システム及び機器
EP3981560A4 (en) * 2019-06-06 2023-01-04 OMRON Corporation TOUCH SENSOR, ROBOT HAND AND ROBOT

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
USD946762S1 (en) * 2019-06-07 2022-03-22 Welch Allyn, Inc. Pedestal
US10988893B2 (en) * 2019-07-18 2021-04-27 Haier Us Appliance Solutions, Inc. Dryer appliance with slide bearing assemblies including wear detection features
EP3842732A4 (en) * 2019-08-02 2022-05-04 Shenzhen Yuejiang Technology Co., Ltd. HOUSING, HOUSING MODULE AND MECHANICAL ARM OF MECHANICAL EQUIPMENT, AND ROBOT
CN110861124B (zh) * 2019-11-27 2021-05-11 山东大学 一种机械臂作业状态下安全防碰系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60108285A (ja) * 1983-11-17 1985-06-13 株式会社日立製作所 非接触センサによる多自由度ロボットの制御方法
JPS6375913U (ja) * 1986-03-27 1988-05-20
JP2007123202A (ja) * 2005-10-31 2007-05-17 Asmo Co Ltd コードスイッチ及びこれを用いた検知装置
JP2008269950A (ja) * 2007-04-20 2008-11-06 Shin Etsu Polymer Co Ltd 操作スイッチ用カバー部材及び操作スイッチ
JP5435679B2 (ja) * 2010-05-31 2014-03-05 独立行政法人産業技術総合研究所 直動伸縮アーム機構および当該直動伸縮アーム機構を備えたロボットアーム
JP2014149974A (ja) * 2013-02-01 2014-08-21 Tokai Rika Co Ltd スイッチ装置

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5435679A (en) 1977-08-25 1979-03-15 Toshiba Corp Semiconductor connection method
US4621332A (en) * 1983-06-20 1986-11-04 Hitachi, Ltd. Method and apparatus for controlling a robot utilizing force, position, velocity, spring constant, mass coefficient, and viscosity coefficient
JP2006284201A (ja) * 2005-03-31 2006-10-19 Toto Ltd 人体検出装置

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60108285A (ja) * 1983-11-17 1985-06-13 株式会社日立製作所 非接触センサによる多自由度ロボットの制御方法
JPS6375913U (ja) * 1986-03-27 1988-05-20
JP2007123202A (ja) * 2005-10-31 2007-05-17 Asmo Co Ltd コードスイッチ及びこれを用いた検知装置
JP2008269950A (ja) * 2007-04-20 2008-11-06 Shin Etsu Polymer Co Ltd 操作スイッチ用カバー部材及び操作スイッチ
JP5435679B2 (ja) * 2010-05-31 2014-03-05 独立行政法人産業技術総合研究所 直動伸縮アーム機構および当該直動伸縮アーム機構を備えたロボットアーム
JP2014149974A (ja) * 2013-02-01 2014-08-21 Tokai Rika Co Ltd スイッチ装置

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113874178A (zh) * 2019-06-06 2021-12-31 欧姆龙株式会社 触觉传感器、机械手以及机器人
EP3981560A4 (en) * 2019-06-06 2023-01-04 OMRON Corporation TOUCH SENSOR, ROBOT HAND AND ROBOT
EP3981559A4 (en) * 2019-06-06 2023-01-11 OMRON Corporation TOUCH SENSOR, ROBOT HAND AND ROBOT
WO2022070712A1 (ja) * 2020-10-01 2022-04-07 パナソニックIpマネジメント株式会社 近接センサ、制御システム及び機器
KR20230048418A (ko) 2020-10-01 2023-04-11 파나소닉 아이피 매니지먼트 가부시키가이샤 근접 센서, 제어 시스템 및 기기

Also Published As

Publication number Publication date
US20190248020A1 (en) 2019-08-15
DE112017005497T5 (de) 2019-08-08
JP6829264B2 (ja) 2021-02-10
CN109844894B (zh) 2022-01-18
JPWO2018079771A1 (ja) 2019-09-19
CN109844894A (zh) 2019-06-04
US11407121B2 (en) 2022-08-09

Similar Documents

Publication Publication Date Title
WO2018079771A1 (ja) 近接センサ装置及びロボットアーム機構
WO2018079772A1 (ja) ロボットアーム機構
WO2017170305A1 (ja) 近接センサ装置及びロボットアーム機構
US10646089B2 (en) Touch sensing device and robot
JP6756166B2 (ja) 力覚センサーユニットおよびロボット
US8881616B2 (en) High degree of freedom (DoF) controller
US20190145798A1 (en) Sensor and robot
US9575504B2 (en) High degree of freedom (DOF) controller
JP2010244797A (ja) ジョグダイヤルおよび操作器
US11346978B2 (en) Robot arm mechanism
JP6711911B2 (ja) 直動伸縮機構
JP6391252B2 (ja) ロボット装置
CN1836852A (zh) 多关节操作杆
CN102264259B (zh) 用于家具驱动装置的触发传感器
US9691966B2 (en) Surface-mounted collision sensor, and method for collision detection
US5508686A (en) Overtravel detecting device for an industrial robot
JP2018140445A (ja) ロボット装置
Hartisch et al. Co-design of environmental compliance for high-speed contact tasks
CN216907872U (zh) 检测组件以及自移动机器人
US11391349B1 (en) Compact angular actuator
WO2023074140A1 (ja) 先端手首装置およびロボットアーム装置
JP7181055B2 (ja) ロボット装置
CN114010119A (zh) 检测组件以及自移动机器人
CN116614022A (zh) 一种尺蠖执行装置及其工作方法
CN115107066A (zh) 一种机械臂的末端旋拧工具

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: 17864891

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2018547821

Country of ref document: JP

Kind code of ref document: A

122 Ep: pct application non-entry in european phase

Ref document number: 17864891

Country of ref document: EP

Kind code of ref document: A1