WO2016111041A1 - 工作装置 - Google Patents

工作装置 Download PDF

Info

Publication number
WO2016111041A1
WO2016111041A1 PCT/JP2015/074822 JP2015074822W WO2016111041A1 WO 2016111041 A1 WO2016111041 A1 WO 2016111041A1 JP 2015074822 W JP2015074822 W JP 2015074822W WO 2016111041 A1 WO2016111041 A1 WO 2016111041A1
Authority
WO
WIPO (PCT)
Prior art keywords
drive
working
machine tool
operator
nut runner
Prior art date
Application number
PCT/JP2015/074822
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 CN201580068176.3A priority Critical patent/CN107428007B/zh
Priority to JP2016568272A priority patent/JP6545195B2/ja
Priority to US15/542,316 priority patent/US10723021B2/en
Publication of WO2016111041A1 publication Critical patent/WO2016111041A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23PMETAL-WORKING NOT OTHERWISE PROVIDED FOR; COMBINED OPERATIONS; UNIVERSAL MACHINE TOOLS
    • B23P19/00Machines for simply fitting together or separating metal parts or objects, or metal and non-metal parts, whether or not involving some deformation; Tools or devices therefor so far as not provided for in other classes
    • B23P19/04Machines for simply fitting together or separating metal parts or objects, or metal and non-metal parts, whether or not involving some deformation; Tools or devices therefor so far as not provided for in other classes for assembling or disassembling parts
    • B23P19/06Screw or nut setting or loosening machines
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23PMETAL-WORKING NOT OTHERWISE PROVIDED FOR; COMBINED OPERATIONS; UNIVERSAL MACHINE TOOLS
    • B23P19/00Machines for simply fitting together or separating metal parts or objects, or metal and non-metal parts, whether or not involving some deformation; Tools or devices therefor so far as not provided for in other classes
    • B23P19/10Aligning parts to be fitted together
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • 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/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/085Force or torque 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/06Safety devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/106Programme-controlled manipulators characterised by positioning means for manipulator elements with articulated links
    • B25J9/1065Programme-controlled manipulators characterised by positioning means for manipulator elements with articulated links with parallelograms
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66CCRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
    • B66C23/00Cranes comprising essentially a beam, boom, or triangular structure acting as a cantilever and mounted for translatory of swinging movements in vertical or horizontal planes or a combination of such movements, e.g. jib-cranes, derricks, tower cranes
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23PMETAL-WORKING NOT OTHERWISE PROVIDED FOR; COMBINED OPERATIONS; UNIVERSAL MACHINE TOOLS
    • B23P19/00Machines for simply fitting together or separating metal parts or objects, or metal and non-metal parts, whether or not involving some deformation; Tools or devices therefor so far as not provided for in other classes
    • B23P19/04Machines for simply fitting together or separating metal parts or objects, or metal and non-metal parts, whether or not involving some deformation; Tools or devices therefor so far as not provided for in other classes for assembling or disassembling parts
    • B23P19/06Screw or nut setting or loosening machines
    • B23P19/065Arrangements for torque limiters or torque indicators in screw or nut setting machines
    • B23P19/066Arrangements for torque limiters or torque indicators in screw or nut setting machines by electrical means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00Gripping heads and other end effectors
    • B25J15/0019End effectors other than grippers
    • 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
    • Y10TTECHNICAL SUBJECTS COVERED BY FORMER US CLASSIFICATION
    • Y10T29/00Metal working
    • Y10T29/53Means to assemble or disassemble
    • Y10T29/53039Means to assemble or disassemble with control means energized in response to activator stimulated by condition sensor
    • Y10T29/53061Responsive to work or work-related machine element
    • 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
    • Y10TTECHNICAL SUBJECTS COVERED BY FORMER US CLASSIFICATION
    • Y10T29/00Metal working
    • Y10T29/53Means to assemble or disassemble
    • Y10T29/534Multiple station assembly or disassembly apparatus
    • Y10T29/53417Means to fasten work parts together

Definitions

  • the present invention relates to a machine tool.
  • Patent Document 1 discloses a fastening device as a conventional machine tool.
  • This fastening device includes a nut runner as a working means, a link mechanism, a driving means, and a current coordinate detecting means. Further, this fastening device can be recognized as including a storage unit and a control unit.
  • the nut runner has an action part that can act on the workpiece. More specifically, the nut runner has a rotation shaft that can be driven to rotate, and the action portion can engage the fastener with the workpiece.
  • the link mechanism enables the nut runner to move while holding the nut runner.
  • the driving means drives the link mechanism to move the nut runner.
  • the current coordinate detection means detects the current coordinates of the nut runner.
  • the storage means stores target coordinates for positioning the nut runner so that the acting portion of the nut runner acts on the workpiece.
  • the control means controls the driving means to move the nut runner from the current coordinates to the target coordinates.
  • the control means controls all of the movement of the machining means from the current coordinates to the target coordinates, and the linear movement of the action portion in the target coordinates and the rotation of the rotation axis.
  • this type of machine device is a robot in which the operator is not involved in the machine work at all. For this reason, the machine tool of this type is large in size as a whole, and the manufacturing cost is likely to increase.
  • the present invention has been made in view of the above-described conventional situation, and it is an object to be solved to provide a machine tool that can realize downsizing and can reduce the manufacturing cost.
  • the machine tool of the present invention a machine means having an action portion that can act on the workpiece, A link mechanism that enables movement of the working means while holding the working means; Drive means for driving the link mechanism to move the work means; Current coordinate detection means for detecting current coordinates of the machining means; Storage means for storing target coordinates for positioning the working means for causing the action portion to act on the workpiece; Control means for controlling the drive means to move the working means from the current coordinates to the target coordinates, Provided in the working means, further comprising a continuous stop detection means for generating a continuation signal if the operator's operation input is continuously performed, and generating a stop signal if the operation input is not continuously performed,
  • the control means has a drive continuation stop unit that drives the drive means by the continuation signal and stops the drive means by the stop signal.
  • the machine means is provided with continuous stop detecting means, and the control means has a drive continuous stop section. For this reason, if the operator continuously inputs the operation during the movement of the working means from the current coordinates to the target coordinates, the continuous stop detecting means generates a continuation signal, and the drive continuation stop portion is driven by the continuation signal. Continue to drive the means. For this reason, since the operator can move the working means to the target coordinates as long as the operation input is continuously performed, the operator does not need to memorize the target coordinates, and the load on the operator is small. .
  • this machine tool involves the operator during the movement of the machine means from the current coordinates to the target coordinates. Even if the operator is involved in the work, if the operation input is not continuously performed, the driving means stops without running away, so that the safety of the operator is ensured. For this reason, this machine tool does not require a partition or the like for isolating the worker from the work.
  • this machine tool can be miniaturized and the manufacturing cost can be reduced.
  • the machine tool of the present invention may further include an operating force detection unit that is provided in the machine unit and detects an operator's operation force. And it is preferable that the control means has a first drive speed changing section that changes the drive speed of the drive means by the output signal of the operating force detection means.
  • the drive speed of the drive means changes according to the operating force exerted on the work means by the operator. For example, if the operator operates the machining means with a strong operating force, the driving speed of the driving means increases, and if the operator operates the machining means with a weak operating force, the driving speed of the driving means decreases. For this reason, in this machine tool, an operator who is not accustomed to a certain work can perform the work carefully and spend time to get used to the work. Conversely, if the worker gets used to the same work, the work can be completed early.
  • the machine tool of the present invention may further include an operating state detecting unit that detects a physical quantity that operates the driving unit. And it is preferable that a control means has a 2nd drive speed change part which changes the drive speed of a drive means with the output signal of an operation state detection means.
  • the drive speed of the drive means changes according to the physical quantity for operating the drive means.
  • the drive means employs a servo motor
  • the current value of the current supplied to the servo motor can be detected by the operating state detection means. If the current value exceeds the threshold value, it is considered that the working means interferes with some obstacle and the torque of the servo motor is increased. For this reason, in that case, the driving speed can be lowered or stopped.
  • the drive means employs a hydraulic pump
  • the flow rate of the pressure oil supplied to the hydraulic pump can be detected by the operating state detection means.
  • the drive means employs an air cylinder
  • the flow rate of the pressurized air supplied to the air cylinder can be detected by the operating state detection means.
  • the control means preferably has a brake part for controlling the driving means so that the machining means converges to the target coordinates when the machining means is located in the vicinity of the target coordinates. In this case, the working means can be smoothly moved from the current coordinates to the target coordinates.
  • the control means preferably has a positioning portion that generates a positioning signal when the machining means converges to the target coordinates. In this case, it can be confirmed that the machining means is positioned at the target coordinates. For this reason, for example, the operator can operate the work means based on this confirmation, and the storage means can record the work work.
  • the working means has a rotation shaft that can be driven to rotate, the action portion can engage the fastener, and the action portion can be fastened to the workpiece by rotating the rotation shaft while moving straight in the axial direction.
  • a nut runner is preferred. In this case, it is possible to perform a work operation for fastening the fastener to the workpiece by the nut runner.
  • the working means is preferably a servo press that has a rotating shaft that can be rotationally driven by a servomotor, and the action portion can move straight in the axial direction by the rotation of the rotating shaft and press against the workpiece.
  • a work such as crimping or press fitting of the workpiece can be performed by the servo press.
  • FIG. 1 is a side view of a fastening device that is a machine tool according to the first embodiment.
  • FIG. 2 is a plan view of the fastening device of the first embodiment.
  • FIG. 3 is a block diagram of the fastening device according to the first embodiment.
  • FIG. 4 is a schematic perspective view illustrating a teaching state according to the fastening device of the first embodiment.
  • FIG. 5 is a part of a flowchart of the fastening device according to the first embodiment.
  • FIG. 6 is a part of a flowchart of the fastening device according to the first embodiment.
  • FIG. 7 is a part of a flowchart of the fastening device according to the first embodiment.
  • FIG. 1 is a side view of a fastening device that is a machine tool according to the first embodiment.
  • FIG. 2 is a plan view of the fastening device of the first embodiment.
  • FIG. 3 is a block diagram of the fastening device according to the first embodiment.
  • FIG. 8 is a schematic perspective view illustrating target coordinates of each position according to the fastening device of the first embodiment.
  • FIG. 9 is a graph showing the relationship between the target coordinates and the current supplied to the first and second servomotors in the fastening device of the first embodiment.
  • FIG. 10 is a side view of a pressurizing device that is a working device of the second embodiment.
  • FIG. 11 is a block diagram of the fastening device of the third embodiment.
  • FIG. 12 is a part of a flowchart of the fastening device according to the third embodiment.
  • Embodiments 1 to 3 embodying the present invention will be described below with reference to the drawings.
  • Example 1 The machine tool of Example 1 is a fastening device. As shown in FIGS. 1 and 2, the fastening device includes a base 1, a link mechanism 3, first and second servomotors 5 and 7, and a known nut runner 9.
  • the workpiece W can be positioned and fixed on the base 1.
  • the base 1 is provided with an origin confirmation base 11.
  • a recess 11a is formed into which the socket 9d of the nut runner 9 can be inserted from above.
  • the base 1 is provided with a link mechanism 3.
  • the first hinge 13 is fixed to the side surface of the base 1.
  • the first hinge 13 has a horizontal arm 15 that can swing about a swing axis O1 that extends vertically.
  • the horizontal arm 15 extends horizontally.
  • a second hinge 17 is fixed to the tip of the horizontal arm 15.
  • the second hinge 17 has first and second links 19 and 21 and a damper 23 that can swing around a swing axis O2 that extends vertically.
  • the first link 19 extends in parallel with the second link 19 above the second link 21.
  • the first link 19 is provided on the second hinge 17 so as to be swingable up and down by a pin 17a.
  • the second link 21 is provided on the second hinge 17 so as to be swingable up and down by a pin 17b.
  • the damper 23 has a main body 23 a that can swing up and down on the second hinge 17, and a rod 23 b that can swing up and down by a pin 19 a at the tip of the first link 19.
  • a mounting bracket 25 extending vertically is provided at the tip of the first and second links 19 and 21.
  • the first link 19 and the mounting bracket 25 can swing up and down by a pin 25a, and the second link 21 and the mounting bracket 25 can swing up and down by a pin 25b.
  • These second hinge 17, first and second links 19, 21, damper 23 and mounting bracket 25 constitute a parallel link mechanism 27.
  • the nut runner 9 extending vertically is fixed to the mounting bracket 25 via an idle rotation mechanism (not shown).
  • the nut runner 9 is a known one, and this is a working means.
  • a stopper (not shown) is provided between the second hinge 17 and the first and second links 19 and 21.
  • the first and second links 19 and 21 have a rising end that is horizontal by a stopper.
  • the first and second links 19 and 21 are positioned at the rising end when the operator releases their hands from the nut runner 9 by the damper 23.
  • the link mechanism 3 enables the nut runner 9 to move three-dimensionally while holding the nut runner 9.
  • a first servomotor 5 capable of horizontally rotating the horizontal arm 15 is provided on the upper portion of the first hinge 13 of the link mechanism 3.
  • the first servo motor 5 is provided with a first position sensor 5a.
  • a second servo motor 7 capable of horizontally rotating the parallel link mechanism 27 is provided on the second hinge 17.
  • the second servomotor 7 is provided with a second position sensor 7a.
  • the first and second position sensors 5a and 7a can detect the current coordinates of the nut runner 9 on the xy plane.
  • the first and second servo motors 5 and 7 correspond to drive means.
  • the first and second position sensors 5a and 7a correspond to current coordinate detection means.
  • the raising and lowering of the nut runner 9 by the parallel link mechanism 27 is performed manually. That is, the nut runner 9 is positioned on the horizontal xy plane by the first and second servo motors 5 and 7 and is manually lifted and lowered in the z-axis direction orthogonal to the xy plane.
  • the nut runner 9 has a main body 9a incorporating a servo motor and a speed reducer, and a handle portion 9b positioned below the main body 9a and gripped by an operator.
  • a rotating shaft 9c that can be driven to rotate is projected from the lower end of the handle portion 9b, and a socket 9d is fixed to the lower end of the rotating shaft 9c.
  • the socket 9d can be engaged with a bolt head or a nut fastener C (see FIG. 4).
  • a handle SW 29 is provided on the handle portion 9 b of the nut runner 9.
  • the handle SW29 is present at a position where the operator grips the nut runner 9 to move and rotate the socket 9d.
  • the main body 9 a and the handle portion 9 b are lowered manually by the operator, and the socket 9 d can screw the fastener C to the workpiece W.
  • the socket 9d is an action part.
  • the handle SW29 is a continuous stop detection means.
  • a force sensor 33 is provided on the handle portion 9b of the nut runner 9.
  • the force sensor 33 can detect the operation force of the operator.
  • the force sensor 33 corresponds to the operating force detection means.
  • the nut runner 9 is provided with an operation lamp 35 and a tightening completion lamp 37 as shown in FIG.
  • the fastening device includes a controller 41 and a storage device 43. Connected to the controller 41 are the servo motor of the nut runner 9, the first and second servo motors 5 and 7, the first and second position sensors 5 a and 7 a, the handle SW 29, the force sensor 33, the operation lamp 35 and the tightening completion lamp 37. Has been.
  • the controller 41 stores a program that can execute the flowcharts shown in FIGS.
  • the storage device 43 can store a plurality of target coordinates for positioning the nut runner 9 so that the socket 9d of the nut runner 9 acts on the workpiece W.
  • the operator moves the nut runner 9 while grasping the handle SW29, inserts the socket 9d into the recess 11a, and then inserts the socket 9d into the fastener C on the workpiece W sequentially.
  • each target coordinate is taught. For example, if the socket 9d is in the recess 11a, the current coordinate P (x, y) of the nut runner 9 there is the origin O (x0, y0).
  • the current coordinate P (x, y) is set to the A position (x1, y1). Further, at the place where the fastener C is next screwed to the workpiece W, the current coordinate P (x, y) is set to the B position (x2, y2). Further, at the place where the fastener C is next screwed to the workpiece W, the current coordinate P (x, y) is set to the C position (x3, y3).
  • each target coordinate is not an actual three-dimensional coordinate in which the socket 9d is screwed to the fastener C on the workpiece W, but the value of the actual coordinate in the z-axis direction is set to 0, and the parallel link mechanism 27 is on the xy plane obtained by correcting the horizontal displacement by 27 in the x-axis direction and the y-axis direction. It should be noted that the order of each target coordinate can be changed after each target coordinate is stored in the storage device 43.
  • the storage device 43 shown in FIG. 3 can also record the target tightening torque and the result tightening torque at each target coordinate.
  • This fastening device operates according to the flowcharts of FIGS. 5 to 7 when the operation switch is turned on.
  • initial setting is performed in step S1.
  • the servo motor of the nut runner 9, the first and second servo motors 5 and 7, the first and second position sensors 5a and 7a, the handle SW 29, the force sensor 33, the operation lamp 35, the tightening completion lamp 37, etc. are checked. Done.
  • Each target coordinate is stored in the storage device 43 by a personal computer (PC).
  • step S2 the operator moves the nut runner 9 while grasping the handle portion 9b together with the handle SW29, and returns the origin O by inserting the socket 9d into the recess 11a. In this state, a reset signal is transmitted to the controller 41, and the controller 41 is reset in step S3.
  • step S4 the operator inputs a model selection signal for specifying the fastening work. Thereby, in step S5, the operation lamp 35 is turned on.
  • step S6 a signal from the handle SW 29 is awaited and a signal from the force sensor 33 is awaited.
  • step S7 it is determined whether or not there is a continuation signal of the handle SW29. If YES here, during the movement of the nut runner 9 from the current coordinates P (x, y) to, for example, the A position (x1, y1), the operator continuously holds the handle SW29, and the handle SW29 Transmits a continuation signal to the controller 41. For this reason, the controller 41 continues to drive the first and second servomotors 5 and 7 in step S8. Therefore, as long as the operator holds the handle SW29 continuously, the nut runner 9 can be brought close to the A position (x1, y1), so that the operator stores the A position (x1, y1). There is no need and the load on the operator is small.
  • step S7 the operator suddenly releases the handle SW29 during the movement of the nut runner 9 from the current coordinates P (x, y) to the A position (x1, y1), and the handle SW29. Transmits a stop signal to the controller 41. Therefore, the controller 41 stops the first and second servo motors 5 and 7 in step S9. Then, the process returns to step S6.
  • this fastening device involves an operator during the movement of the nut runner 9 from the current coordinates P (x, y) to the A position (x1, y1).
  • Steps S6 to S9 correspond to the drive continuation stop unit.
  • step S10 it is determined whether or not the current coordinate P (x, y) is near the A position (x1, y1). At this time, for example, as shown in FIG. 8, if a circle with a constant radius centered on the A position (x1, y1) is hypothesized, and the current coordinate P (x, y) is located within this circle, the current coordinate If it is determined that P (x, y) is near the A position (x1, y1) and the current coordinates P (x, y) are located outside this circle, the current coordinates P (x, y) are x1, y1) Judge that it is not near.
  • step S11 brake-control the first and second servomotors 5 and 7.
  • the brake control is performed by supplying a current value (A) to the first and second servomotors 5 and 7 so that the brakes are generated in the first and second servomotors 5 and 7 as the target coordinates approach. ).
  • Steps S10 and S11 correspond to a brake part. If NO here, the process returns to the step S6. In this way, the nut runner 9 can be smoothly moved from the current coordinate P (x, y) to the A position (x1, y1).
  • step S12 it is determined whether or not the operator's operating force input from the force sensor 33 exceeds a predetermined first reference force Fs. If the operating force exceeds the first reference force Fs (YES), the process proceeds to step S13, and the first and second servo motors 5 and 7 are accelerated. On the other hand, if the operating force is below the first reference force Fs (NO), the process proceeds to step S14, and the first and second servo motors 5 and 7 are decelerated. For example, in the acceleration control of the first and second servomotors 5 and 7, as shown in FIG. 9, the current value (A) energized to the first and second servomotors 5 and 7 is increased.
  • step S14 the deceleration control of the first and second servomotors 5 and 7 decreases the current value (A) applied to the first and second servomotors 5 and 7.
  • step S15 it is determined whether or not the operator's operating force is less than a predetermined second reference force Ff. If the operating force is less than the second reference force Ff (YES), the process proceeds to step S16, and the first and second servo motors 5 and 7 are decelerated. On the other hand, if the operating force exceeds the second reference force Ff (NO), the process proceeds to step S17, and the first and second servo motors 5 and 7 are accelerated. After executing step S17, the process returns to step S6. Steps S12 to S17 correspond to the first drive speed changing unit.
  • this fastening device when the operator operates the nut runner 9 with a strong operating force, the drive speed of the first and second servo motors 5 and 7 increases, and the operator operates the nut runner 9 with a weak operating force. Then, the drive speeds of the first and second servo motors 5 and 7 are reduced. For this reason, in this fastening device, an operator who is not accustomed to a certain fastening work can perform the fastening work carefully over time and get used to the fastening work. On the contrary, if the worker gets used to the same fastening work, the fastening work can be completed early.
  • step S18 it is determined whether or not the current coordinates P (x, y) are in the A position (x1, y1). If "YES” here, the process proceeds to a step S19 to lock-control the first and second servomotors 5 and 7. In the lock control, for example, as shown in FIG. 9, the current value (A) energized to the first and second servomotors 5 and 7 is maximized. If NO here, the process returns to the step S6.
  • step S19 After step S19 is executed, the operation lamp 35 is turned off in step S20.
  • the operator can confirm that the nut runner 9 is positioned by this, and know that it is time to lower the nut runner 9.
  • Steps S18 and S19 correspond to the positioning unit.
  • step S21 the operator manually lowers the nut runner 9.
  • the lock control is released. Further, the process waits until the socket 9d is pressed upward from the workpiece W at a certain pressure or higher.
  • step S23 if the handle SW29 is continuously gripped at this time, the rotating shaft 9c rotates so that the fastener C can be fastened with the target tightening torque. As a result, the socket 9d can screw the fastener C into the workpiece W at the A position (x1, y1).
  • step S24 it is determined whether or not the resultant tightening torque is within the reference range. If the result tightening torque is within the reference range (YES), the process proceeds to step S25, and this is recorded in the storage device 43. If the result tightening torque is not within the reference range (NO), the process proceeds to step S26 and an alarm is issued, and then the process proceeds to step S25 and this is recorded in the storage device 43. In step S ⁇ b> 27, the resultant tightening torque is output from the nut runner 9 when the fastener C is actually fastened.
  • step S28 one-position end processing is performed. For example, the fastening at the A position (x1, y1) is completed. Thereafter, in step S29, it is determined whether or not another position still remains. If “YES” here, the process returns to the step S6. In this way, similar fastening is also performed at the B position (x2, y2), the C position (x3, y3), and the like. If “NO” in the step S29, the comprehensive determination is output in a step S30, and the process returns to the step S1 so as to perform the fastening operation of the designated model number.
  • the nut runner 9 moves to each target coordinate while assisting the operator.
  • the raising and lowering of the nut runner 9 and the rotation of the socket 9d are based on operator input.
  • the fastening device can be downsized and the manufacturing cost can be reduced.
  • the working device of the second embodiment is a pressurizing device that employs a known servo press 10 as a working means.
  • Servo press 10 incorporates a servo motor, a speed reducer, and a rotating shaft (not shown), and the rotating shaft is driven to rotate by the servo motor.
  • the action portion 10a can move straight in the axial direction by the rotation of the rotating shaft and press against the workpiece.
  • the base 1, the link mechanism 3, the first and second servo motors 5 and 7, the first and second position sensors 5a and 7a, the handle SW 29, the force sensor 33, the controller 41, and the storage device 43 are the same as the fastening device of the first embodiment. It is.
  • the servo press 10 can perform work operations such as caulking of the workpiece and press-fitting. And also in this pressurization apparatus, size reduction can be implement
  • a current sensor 61 is further provided in the controller 41 in the fastening device of the first embodiment.
  • the current sensor 61 corresponds to an operating state detection unit.
  • the current sensor 61 can detect the current value of the current that flows through the first and second servomotors 5 and 7.
  • the controller 41 stores a program that can execute the flowcharts shown in FIGS.
  • Other configurations of the third embodiment are the same as those of the first embodiment. For this reason, the same code
  • step S31 initial setting is performed in the same manner as in step S1 shown in FIG.
  • each target coordinate is memorize
  • each target coordinate can be stored in the storage device 43 more easily without using a PC.
  • step S9 the process up to step S9 is the same as in the first embodiment.
  • step S41 it is determined whether or not the current value detected by the current sensor 61 exceeds a predetermined current reference value A1. If the current value is smaller than the current reference value A1 (YES), the process proceeds to step S10. Steps S10 and S11 are the same as in the first embodiment.
  • step S41 If it is determined in step S41 that the current value is equal to or greater than the current reference value A1 (NO), the process proceeds to step S42.
  • step S42 it is determined whether or not the over time during which the current value continuously exceeds the current reference value A1 is greater than a predetermined first reference time T1. If the overtime is equal to or shorter than the first reference time T1 (NO), the current value has increased instantaneously. For example, it can be determined that there is no obstacle on the moving path of the nut runner 9. Therefore, the process returns to step 9.
  • step S42 if the overtime is larger than the first reference time T1 (YES), for example, it is considered that an obstacle is present on the moving path of the nut runner 9, so the process proceeds to step 43.
  • step S43 it is determined whether or not the over time exceeds a predetermined second reference time T2. If the overtime is equal to or longer than the second reference time T2 (NO), it is considered that there are still obstacles on the moving path of the nut runner 9, so the process proceeds to step S8, and the first and second servos The motors 5 and 7 are stopped.
  • step S43 if the overtime is smaller than the second reference time T2 in step S43 (YES), the process proceeds to step S44, and the first and second servo motors 5 and 7 are decelerated. Then, the process returns to step S9. Steps S8 and S41 to 44 correspond to the second drive speed changing unit. Other steps are the same as those in the first embodiment.
  • the working means according to the present invention is not limited to the nut runner 9 of the first and third embodiments and the servo press 10 of the second embodiment. Various things can be adopted.
  • the parallel link mechanism 27 of the first to third embodiments may not be used, but a link rail that extends vertically and a slider that slides on the guide rail may be used. it can.
  • the drive source is used only as the drive means for horizontally swinging the horizontal arm 15 and the first and second links 19 and 21.
  • the drive means is used for raising and lowering the work means. Sources can also be employed. These drive sources are not limited to servo motors, and stepping motors, servo cylinders, and the like can also be employed.
  • the target coordinates are the coordinates (x, y) on the xy plane, but the target coordinates may be three-dimensional coordinates (x, y, z).
  • the first and second position sensors 5a and 7a are provided in the servo press 10 in order to detect the current coordinates P (x, y) of the nut runner 9 and the servo press 10, but the nut A position sensor may be provided in the runner 9 or the servo press 10 to detect these current coordinates. Further, a camera capable of photographing the working means may be provided in the work place, and the current coordinates of the working means may be detected by this camera.
  • the present invention can be used for fastening devices, pressurizing devices, and the like.
  • Continuous stop detection means (handle SW) S6 to 9: Driving continuation stop unit 33: Operating force detection means (force sensor) S12 to 17: First driving speed changing unit 61: Operating state detecting means (current sensor) S8, 41 to 44 ... second drive speed changing unit S10, 11 ... brake unit S18, 19 ... positioning unit 9c ... rotating shaft 9 ... nut runner 10 ... servo press

Abstract

 小型化を実現でき、製造コストの低廉化を実現可能な工作装置を提供する。 本発明の工作装置では、ナットランナー9等の工作手段にハンドルSW29が設けられている。ハンドルSW29は、作業者の操作入力が継続的に行われていれば継続信号を生じ、操作入力が継続的に行われていなければ停止信号を生じる。コントローラ41は、ステップS6~9によって、継続信号によって第1、2サーボモータ5、7を駆動し、停止信号によって第1、2サーボモータ5、7を停止させる。

Description

工作装置
 本発明は工作装置に関する。
 特許文献1に従来の工作装置としての締結装置が開示されている。この締結装置は、工作手段としてのナットランナーと、リンク機構と、駆動手段と、現在座標検出手段とを備えている。また、この締結装置は、記憶手段と制御手段とを備えると認定し得る。
 ナットランナーは、ワークに対して作用可能な作用部を有している。より具体的には、ナットランナーは回転駆動可能な回転軸を有し、作用部は締結具をワークに係合することが可能である。リンク機構は、ナットランナーを保持しつつナットランナーの移動を可能としている。駆動手段は、ナットランナーを移動させるためにリンク機構を駆動する。現在座標検出手段は、ナットランナーの現在座標を検出する。記憶手段は、ナットランナーの作用部をワークに対して作用させるためにナットランナーを位置させる目標座標を記憶している。制御手段は、ナットランナーを現在座標から目標座標まで移動させるために駆動手段を制御する。
 この締結装置では、複数の目標座標をそれらの順番とともに記憶手段に記憶させておけば、ナットランナーが自動的に各目標座標に移動する。また、この締結装置では、各目標座標において、作用部が自動的に軸方向、例えば上下方向に直進し、これとともに回転軸が回転する。このため、この締結装置では、締結作業に作業者を用いることなく、複数の締結具をワークに対して自動的に締結可能である。
特許第4048142号公報
 しかし、従来の締結装置等の工作装置では、現在座標から目標座標までへの工作手段の移動と、目標座標における作用部の軸方向の直進及び回転軸の回転とを全て制御手段が制御している。つまり、この種の工作装置は、作業者が工作作業に全く関与しないロボットである。このため、この種の工作装置は、全体が大型化し、製造コストが高騰化し易い。
 本発明は、上記従来の実情に鑑みてなされたものであって、小型化を実現でき、製造コストの低廉化を実現可能な工作装置を提供することを解決すべき課題としている。
 本発明の工作装置は、ワークに対して作用可能な作用部を有する工作手段と、
 前記工作手段を保持しつつ前記工作手段の移動を可能とするリンク機構と、
 前記工作手段を移動させるために前記リンク機構を駆動する駆動手段と、
 前記工作手段の現在座標を検出する現在座標検出手段と、
 前記作用部を前記ワークに対して作用させるために前記工作手段を位置させる目標座標を記憶する記憶手段と、
 前記工作手段を前記現在座標から前記目標座標まで移動させるために前記駆動手段を制御する制御手段とを備え、
 前記工作手段に設けられ、作業者の操作入力が継続的に行われていれば継続信号を生じ、前記操作入力が継続的に行われていなければ停止信号を生じる継続停止検知手段をさらに備え、
 前記制御手段は、前記継続信号によって前記駆動手段を駆動し、前記停止信号によって前記駆動手段を停止させる駆動継続停止部を有することを特徴とする。
 本発明の工作装置は、工作手段に継続停止検知手段が設けられ、制御手段が駆動継続停止部を有している。このため、現在座標から目標座標までへの工作手段の移動中、作業者が操作入力を継続的に行っておれば、継続停止検知手段が継続信号を生じ、駆動継続停止部が継続信号によって駆動手段を継続して駆動する。このため、作業者は、操作入力を継続的に行ってさえおれば、工作手段を目標座標に移動することができるため、作業者が目標座標を記憶する必要がなく、作業者の負荷が小さい。
 一方、現在座標から目標座標までへの工作手段の移動中、作業者が不意に工作手段から手を放すなど、操作入力が継続的に行われなければ、継続停止検知手段が停止信号を生じ、駆動継続停止部が停止信号によって駆動手段を停止させる。こうして、この工作装置は、現在座標から目標座標までへの工作手段の移動中に作業者が関与する。また、作業者が工作作業に関与しても、操作入力が継続的に行われていなければ、駆動手段は暴走することなく停止するため、その作業者の安全は確保される。このため、この工作装置は、作業者を工作作業から隔離するための隔壁等が不要となる。
 したがって、この工作装置は、小型化を実現でき、製造コストの低廉化を実現可能である。
 本発明の工作装置は、工作手段に設けられ、作業者の操作力を検知する操作力検知手段をさらに備え得る。そして、制御手段は、操作力検知手段の出力信号によって駆動手段の駆動速度を変更する第1駆動速度変更部を有していることが好ましい。
 この場合、作業者が工作手段に及ぼす操作力に応じ、駆動手段の駆動速度が変化する。例えば、作業者が工作手段を強い操作力で操作すれば、駆動手段の駆動速度が速くなり、作業者が工作手段を弱い操作力で操作すれば、駆動手段の駆動速度が遅くなる。このため、この工作装置では、ある工作作業に慣れない作業者は、その工作作業を時間をかけて慎重に行い、その工作作業に慣れることができる。逆に、作業者が同一の工作作業に慣れれば、その工作作業を早期に終えることができる。
 本発明の工作装置は、駆動手段を作動させる物理量を検知する作動状態検知手段をさらに備え得る。そして、制御手段は、作動状態検知手段の出力信号によって駆動手段の駆動速度を変更する第2駆動速度変更部を有していることが好ましい。
 この場合、駆動手段を作動させる物理量に応じ、駆動手段の駆動速度が変化する。例えば、駆動手段がサーボモータを採用しておれば、サーボモータに通電する電流の電流値を作動状態検知手段によって検知することができる。その電流値が閾値を超えておれば、工作手段が何らかの障害物と干渉し、サーボモータのトルクが大きくなっていると考えられる。このため、その場合には、駆動速度を低めたり、停止させたりすることができる。また、駆動手段が油圧ポンプを採用しておれば、油圧ポンプに供給する圧力油の流量を作動状態検知手段によって検知することができる。さらに、駆動手段がエアーシリンダを採用しておれば、エアーシリンダに供給する圧力空気の流量を作動状態検知手段によって検知することができる。他にも、作動状態検知手段は、駆動手段の種類に応じた種々の物理量を検知すれば足りる。
 制御手段は、工作手段が目標座標近傍に位置すれば工作手段が目標座標に収束するように駆動手段を制御するブレーキ部を有していることが好ましい。この場合、現在座標から目標座標までへの工作手段の移動をスムーズに行うことができる。
 制御手段は、工作手段が目標座標に収束すれば位置決め信号を生じる位置決め部を有することが好ましい。この場合、工作手段が目標座標に位置決めされたことが確認できる。このため、例えば、作業者がこの確認に基づいて工作手段に操作を行ったり、記憶手段が工作作業の記録を行ったりすることができる。
 工作手段は、回転駆動可能な回転軸を有し、作用部は締結具を係合可能であり、作用部が軸方向に直進しつつ回転軸の回転によって締結具をワークに対して締結可能なナットランナーであることが好ましい。この場合、ナットランナーによって締結具をワークに対して締結する工作作業を行うことができる。
 工作手段は、サーボモータによって回転駆動可能な回転軸を有し、作用部が回転軸の回転によって軸方向に直進してワークに対して押圧可能なサーボプレスであることも好ましい。この場合、サーボプレスによってワークのカシメ、圧入等の工作作業を行うことができる。
 本発明の工作装置によれば、小型化を実現でき、製造コストの低廉化を実現可能である。
図1は、実施例1の工作装置である締結装置の側面図である。 図2は、実施例1の締結装置の平面図である。 図3は、実施例1の締結装置のブロック構成図である。 図4は、実施例1の締結装置に係り、ティーチング状態を示す模式斜視図である。 図5は、実施例1の締結装置のフローチャートの一部である。 図6は、実施例1の締結装置のフローチャートの一部である。 図7は、実施例1の締結装置のフローチャートの一部である。 図8は、実施例1の締結装置に係り、各ポジションの目標座標を示す模式斜視図である。 図9は、実施例1の締結装置に係り、目標座標と第1、2サーボモータに供給する電流との関係を示すグラフである。 図10は、実施例2の工作装置である加圧装置の側面図である。 図11は、実施例3の締結装置のブロック構成図である。 図12は、実施例3の締結装置のフローチャートの一部である。
 以下、本発明を具体化した実施例1~3を図面を参照しつつ説明する。
(実施例1)
 実施例1の工作装置は締結装置である。この締結装置は、図1及び図2に示すように、基台1と、リンク機構3と、第1、2サーボモータ5、7と、公知のナットランナー9とを備えている。
 基台1上には、ワークWを位置決めして固定できるようになっている。また、基台1には、原点確認台11が設けられている。原点確認台11の上端には、ナットランナー9のソケット9dを上方から挿入可能な凹部11aが形成されている。
 基台1にリンク機構3が設けられている。リンク機構3では、基台1の側面に第1ヒンジ13が固定されている。第1ヒンジ13は垂直に延びる揺動軸心O1周りで揺動可能な水平アーム15を有している。水平アーム15は水平に延びている。水平アーム15の先端には第2ヒンジ17が固定されている。第2ヒンジ17は垂直に延びる揺動軸心O2周りで揺動可能な第1、2リンク19、21及びダンパー23を有している。
 第1リンク19は第2リンク21の上方で第2リンク19と平行に延びている。第1リンク19は第2ヒンジ17にピン17aによって上下に揺動可能に設けられている。また、第2リンク21は第2ヒンジ17にピン17bによって上下に揺動可能に設けられている。ダンパー23は、その本体23aが第2ヒンジ17に上下に揺動可能に設けられ、そのロッド23bが第1リンク19の先端部にピン19aによって上下に揺動可能に設けられている。第1、2リンク19、21の先端には上下に延びる取付ブラケット25が設けられている。第1リンク19と取付ブラケット25とはピン25aによって上下に揺動可能とされ、第2リンク21と取付ブラケット25とはピン25bによって上下に揺動可能とされている。これら第2ヒンジ17、第1、2リンク19、21、ダンパー23及び取付ブラケット25は平行リンク機構27を構成している。
 取付ブラケット25には、上下に延びるナットランナー9が図示しない空転機構を介して固定されている。ナットランナー9は、公知のものであり、これが工作手段である。第2ヒンジ17と第1、2リンク19、21との間には図示しないストッパが設けられている。第1、2リンク19、21は、ストッパにより水平になる状態が上昇端とされている。また、第1、2リンク19、21は、ダンパー23により、作業者がナットランナー9から手を離すと、上昇端に位置するようにされている。こうして、リンク機構3は、ナットランナー9を保持しつつナットランナー9の三次元の移動を可能としている。
 リンク機構3の第1ヒンジ13の上部には、水平アーム15を水平回転駆動可能な第1サーボモータ5が設けられている。第1サーボモータ5には第1位置センサ5aが設けられている。また、第2ヒンジ17の上部には、平行リンク機構27を水平回転駆動可能な第2サーボモータ7が設けられている。第2サーボモータ7には第2位置センサ7aが設けられている。第1、2位置センサ5a、7aは、ナットランナー9のxy平面上の現在座標を検出可能である。第1、2サーボモータ5、7が駆動手段に相当する。第1、2位置センサ5a、7aが現在座標検出手段に相当する。
 平行リンク機構27によるナットランナー9の昇降は手動で行われるようになっている。つまり、ナットランナー9は、水平なxy平面上を第1、2サーボモータ5、7によって位置決めされ、xy平面と直交するz軸方向には手動で昇降するように構成されている。
 ナットランナー9は、サーボモータ及び減速機を内蔵する本体9aと、本体9aの下方に位置して作業者が把持するハンドル部9bとを有している。ハンドル部9bの下端からは回転駆動可能な回転軸9cを突出させており、回転軸9cの下端にはソケット9dが固定されている。ソケット9dは、ボルトの頭部又はナットの締結具C(図4参照)を係合可能になっている。
 また、ナットランナー9のハンドル部9bには、ハンドルSW29が設けられている。ハンドルSW29は、作業者がナットランナー9を移動させ、かつソケット9dを回転させる際に握る位置に存在している。ナットランナー9は、本体9a及びハンドル部9bが作業者の手動によって下降させられ、ソケット9dが締結具CをワークWに螺合することが可能となる。ソケット9dが作用部である。
 ハンドルSW29は、作業者がナットランナー9を移動させる際、作業者がハンドルSW29を握り続けておれば、作業者の操作入力が継続的に行われることとなり、継続信号を生じる。また、ハンドルSW29は、作業者が緊急的にハンドルSW29を放せば、操作入力が継続的に行われなくなり、停止信号を生じる。ハンドルSW29が継続停止検知手段である。
 さらに、ナットランナー9のハンドル部9bには、力センサ33が設けられている。力センサ33は、作業者の操作力を検知可能である。力センサ33が操作力検知手段に相当する。また、ナットランナー9には、図3に示すように、作動ランプ35及び締付完了ランプ37が設けられている。
 また、締結装置は、コントローラ41及び記憶装置43を備えている。コントローラ41には、ナットランナー9のサーボモータ、第1、2サーボモータ5、7、第1、2位置センサ5a、7a、ハンドルSW29、力センサ33、作動ランプ35及び締付完了ランプ37が接続されている。また、コントローラ41には、図5~7に示すフローチャートを実行可能なプログラムが格納されている。
 記憶装置43は、ナットランナー9のソケット9dをワークWに対して作用させるためにナットランナー9を位置させる複数の目標座標を記憶可能である。記憶装置43には、図4に示すように、作業者がハンドルSW29を握りながらナットランナー9を移動させ、ソケット9dを凹部11aに挿入した後、ソケット9dをワークW上の締結具Cに順次位置させることにより、各目標座標がティーチングされる。例えば、ソケット9dが凹部11a内にあれば、そこでのナットランナー9の現在座標P(x,y)が原点O(x0,y0)とされる。また、ワークWに対して初めに締結具Cを螺合する場所では、現在座標P(x,y)がAポジション(x1,y1)とされる。また、ワークWに対して次に締結具Cを螺合する場所では、現在座標P(x,y)がBポジション(x2,y2)とされる。さらに、ワークWに対して次に締結具Cを螺合する場所では、現在座標P(x,y)がCポジション(x3,y3)とされる。
 ここで、図1に示すように、平行リンク機構27はナットランナー9を下降させる際にナットランナー9を水平にも変位させる。このため、各目標座標は、ソケット9dがワークW上で締結具Cを螺合する実際の三次元の座標ではなく、その実際の座標のz軸方向の値を0とするとともに、平行リンク機構27による水平方向の変位分をx軸方向及びy軸方向で補正したxy平面上のものとなっている。なお、記憶装置43に各目標座標を記憶後、各目標座標の順番を入れ替えることも可能である。
 また、図3に示す記憶装置43には、各目標座標における目標締付トルクと、結果締付トルクとを記録することも可能になっている。
 この締結装置は、作動スイッチがONされることにより、図5~7のフローチャートに沿って作動する。まず、図5に示すように、ステップS1では、初期設定が行われる。この際、ナットランナー9のサーボモータ、第1、2サーボモータ5、7、第1、2位置センサ5a、7a、ハンドルSW29、力センサ33、作動ランプ35、締付完了ランプ37等のチェックが行われる。また、パソコン(PC)によって記憶装置43に各目標座標が記憶される。
 そして、ステップS2では、目標座標を作業者がハンドルSW29とともにハンドル部9bを握りながらナットランナー9を移動させ、ソケット9dを凹部11aに挿入して原点Oの復帰を行う。この状態でコントローラ41にリセット信号が送信され、ステップS3において、コントローラ41がリセットされる。また、ステップS4では、作業者が締結作業を特定する機種選択信号を入力する。これにより、ステップS5では、作動ランプ35を点灯させる。
 ステップS6では、ハンドルSW29からの信号を待つとともに、力センサ33からの信号を待つ。続くステップS7では、ハンドルSW29の継続信号の有無を判断する。ここで、YESであれば、現在座標P(x,y)から例えばAポジション(x1,y1)までへのナットランナー9の移動中、作業者がハンドルSW29を継続して握っており、ハンドルSW29が継続信号をコントローラ41に送信している。このため、コントローラ41は、ステップS8で第1、2サーボモータ5、7を継続して駆動する。このため、作業者は、ハンドルSW29を継続的に握ってさえおれば、ナットランナー9をAポジション(x1,y1)に近づけることができるため、作業者がAポジション(x1,y1)を記憶する必要がなく、作業者の負荷が小さい。
 一方、ステップS7でNOであれば、現在座標P(x,y)からAポジション(x1,y1)までへのナットランナー9の移動中、作業者が不意にハンドルSW29から手を放し、ハンドルSW29が停止信号をコントローラ41に送信する。このため、コントローラ41は、ステップS9で第1、2サーボモータ5、7を停止させる。そして、ステップS6に戻る。こうして、この締結装置は、現在座標P(x,y)からAポジション(x1,y1)までへのナットランナー9の移動中に作業者が関与する。また、作業者が締結作業に関与しても、ハンドルSW29を握っているという操作入力が継続的に行われていなければ、第1、2サーボモータ5、7は暴走することなく停止するため、その作業者の安全は確保される。このため、この締結装置は、作業者を締結作業から隔離するための隔壁等が不要となる。ステップS6~9が駆動継続停止部に相当する。
 ステップS8の実行後、ステップS10において、現在座標P(x,y)がAポジション(x1,y1)近傍であるか否かを判断する。この際、例えば、図8に示すように、Aポジション(x1,y1)を中心とする一定半径の円を仮想し、この円内に現在座標P(x,y)が位置すれば、現在座標P(x,y)がAポジション(x1,y1)近傍であると判断し、この円外に現在座標P(x,y)が位置すれば、現在座標P(x,y)がAポジション(x1,y1)近傍ではないと判断する。ここで、YESであれば、ステップS11に進み、第1、2サーボモータ5、7をブレーキ制御する。ブレーキ制御は、例えば、図9に示すように、目標座標が近付くにつれて第1、2サーボモータ5、7にブレーキを生じるように、第1、2サーボモータ5、7に通電する電流値(A)を大きくする。ステップS10、S11がブレーキ部に相当する。ここで、NOであれば、ステップS6に戻る。こうして、現在座標P(x,y)からAポジション(x1,y1)までへのナットランナー9の移動をスムーズに行うことができる。
 図6に示すように、ステップS12では、力センサ33から入力される作業者の操作力が予め定めた第1基準力Fsを超えているか否かを判断する。ここで、操作力が第1基準力Fsを超えておれば(YES)、ステップS13に進み、第1、2サーボモータ5、7を加速する。他方、操作力が第1基準力Fsを下回っておれば(NO)、ステップS14に進み、第1、2サーボモータ5、7を減速する。例えば、第1、2サーボモータ5、7の加速制御は、図9に示すように、第1、2サーボモータ5、7に通電する電流値(A)を増加する。他方、第1、2サーボモータ5、7の減速制御は、第1、2サーボモータ5、7に通電する電流値(A)を減少する。図6に示すステップS14の実行後、ステップS6に戻る。
 また、ステップ13の実行後、ステップS15では、作業者の操作力が予め定めた第2基準力Ff未満であるか否かを判断する。ここで、操作力が第2基準力Ffを下回っておれば(YES)、ステップS16に進み、第1、2サーボモータ5、7を減速する。他方、操作力が第2基準力Ffを超えておれば(NO)、ステップS17に進み、第1、2サーボモータ5、7を加速する。ステップS17の実行後、ステップS6に戻る。ステップS12~17が第1駆動速度変更部に相当する。
 こうして、この締結装置では、作業者がナットランナー9を強い操作力で操作すれば、第1、2サーボモータ5、7の駆動速度が速くなり、作業者がナットランナー9を弱い操作力で操作すれば、第1、2サーボモータ5、7の駆動速度が遅くなる。このため、この締結装置では、ある締結作業に慣れない作業者は、その締結作業を時間をかけて慎重に行い、その締結作業に慣れることができる。逆に、作業者が同一の締結作業に慣れれば、その締結作業を早期に終えることができる。
 ステップS16の実行後、ステップS18では、現在座標P(x,y)がAポジション(x1,y1)になったか否かを判断する。ここで、YESであれば、ステップS19に進み、第1、2サーボモータ5、7をロック制御する。ロック制御は、例えば、図9に示すように、第1、2サーボモータ5、7に通電する電流値(A)を最大とする。ここで、NOであれば、ステップS6に戻る。
 ステップS19の実行後、ステップS20では、作動ランプ35を消灯する。作業者は、これによってナットランナー9が位置決めされたことを確認し、ナットランナー9の下降を行うタイミングであることを知ることができる。ステップS18、S19が位置決め部に相当する。
 ステップS21では、作業者が手動でナットランナー9を下降させる。この際、ステップS22では、ナットランナー9が平行リンク機構27によってx軸方向及びy軸方向に変位するため、ロック制御が解除される。また、ソケット9dがワークWから上方に一定圧力以上で押圧されるまで待つ。ステップS23では、この際にハンドルSW29が継続して握られておれば、目標締付トルクで締結具Cを締結できるように、回転軸9cが回転する。これにより、Aポジション(x1,y1)において、ソケット9dが締結具CをワークWに螺合することが可能となる。
 図7に示すように、ステップS24では、結果締付トルクが基準範囲内にあるか否かが判断される。ここで、結果締付トルクが基準範囲内であれば(YES)、ステップS25に進み、記憶装置43にこれが記録される。結果締付トルクが基準範囲内になければ(NO)、ステップS26に進んで警報された後、ステップS25に進んで記憶装置43にこれが記録される。そして、ステップS27において、実際に締結具Cを締結した際の結果締付トルクがナットランナー9から出力される。
 続くステップS28において、1ポジションの終了処理が行われる。例えば、Aポジション(x1,y1)での締結が終了する。この後、ステップS29において、他のポジションがまだ残存しているか否かが判断される。ここで、YESであれば、ステップS6に戻る。こうして、Bポジション(x2,y2)、Cポジション(x3,y3)等においても、同様の締結が行われる。ステップS29において、NOであれば、ステップS30で総合判定を出力し、指定された機種番号の締結作業を行うべく、ステップS1に戻る。
 こうして、この締結装置では、複数の目標座標をそれらの順番とともに記憶装置43に記憶させておけば、ナットランナー9が作業者を助力しつつ各目標座標に移動する。ナットランナー9の昇降及びソケット9dの回転は作業者の操作入力に基づく。
 したがって、この締結装置は、小型化を実現でき、製造コストの低廉化を実現可能である。
(実施例2)
 実施例2の工作装置は、図10に示すように、工作手段として公知のサーボプレス10を採用した加圧装置である。
 サーボプレス10は、図示しないサーボモータ、減速機及び回転軸を内蔵しており、サーボモータによって回転軸が回転駆動するようになっている。作用部10aは回転軸の回転によって軸方向に直進してワークに対して押圧可能である。基台1、リンク機構3、第1、2サーボモータ5、7、第1、2位置センサ5a、7a、ハンドルSW29、力センサ33、コントローラ41及び記憶装置43は実施例1の締結装置と同様である。
 この加圧装置では、サーボプレス10によってワークのカシメ、圧入等の工作作業を行うことができる。そして、この加圧装置においても、小型化を実現でき、製造コストの低廉化を実現可能である。
(実施例3)
 実施例3の締結装置では、図11に示すように、実施例1の締結装置におけるコントローラ41内に電流センサ61がさらに設けられている。電流センサ61が作動状態検知手段に相当する。電流センサ61は、第1、2サーボモータ5、7に通電する電流の電流値検知可能である。また、コントローラ41には、図12、6、7に示すフローチャートを実行可能なプログラムが格納されている。実施例3のその他の構成は実施例1と同様である。このため、実施例1と同一の構成については同一の符号を付して説明を簡略又は省略する。
 この締結装置は、作動スイッチがONされることにより、図12のフローチャートに沿って作動する。まず、ステップS31では、実施例1の図5に示すステップS1と同様に初期設定が行われる。
 そして、ステップS32では、PCを用いずに記憶装置43に各目標座標が記憶される。すなわち、作業者は、ナットランナー9を各目標座標に順次移動させながら、第1、2位置センサ5a、7aから送信される目標座標を記憶装置43に記憶させる。こうして、この締結装置では、PCを用いることなく、より簡便に記憶装置43に各目標座標を記憶することができる。
 ステップS32の後、ステップS9までは実施例1と同様である。ステップS9の後、ステップS41では、電流センサ61が検知する電流値が予め定めた電流基準値A1を超えているか否かを判断する。ここで、電流値が電流基準値A1よりも小さければ(YES)、ステップS10に進む。ステップS10、S11は実施例1と同様である。
 ステップS41において、電流値が電流基準値A1以上であれば(NO)、ステップS42に進む。ステップS42では、電流値が電流基準値A1を連続して超えているオーバ時間が予め定めた第1基準時間T1よりも大きいか否かを判断する。オーバ時間が第1基準時間T1以下であれば(NO)、瞬間的に電流値が増加したものであり、例えばナットランナー9の移動経路上に障害物が存在していない状態であると判断できるため、ステップ9に戻る。
 ステップS42にいおて、オーバ時間が第1基準時間T1よりも大きければ(YES)、例えばナットランナー9の移動経路上に障害物が存在していると考えられるため、ステップ43に進む。ステップS43では、オーバ時間が予め定めた第2基準時間T2を超えているか否かを判断する。オーバ時間が第2基準時間T2以上であれば(NO)、依然としてナットランナー9の移動経路上に障害物が継続して存在していると考えられるため、ステップS8に進み、第1、2サーボモータ5、7を停止させる。
 他方、ステップS43において、オーバ時間が第2基準時間T2よりも小さければ(YES)、ステップS44に進み、第1、2サーボモータ5、7を減速する。そして、ステップS9に戻る。ステップS8、S41~44が第2駆動速度変更部に相当する。他のステップは実施例1と同様である。
 こうして、この締結装置では、ナットランナー9が何らかの障害物と干渉して第1、2サーボモータ5、7のトルクが大きくなっている場合、駆動速度を低めたり、停止させたりすることができる。
 以上において、本発明を実施例1~3に即して説明したが、本発明は上記実施例1~3に制限されるものではなく、その趣旨を逸脱しない範囲で適宜変更して適用できることはいうまでもない。
 例えば、本発明に係る工作手段としては、実施例1、3のナットランナー9や実施例2のサーボプレス10に限定されず、ワークWに対して作用可能な作用部を有するものであれば、種々のものを採用することが可能である。
 また、本発明に係るリンク機構としては、実施例1~3の平行リンク機構27を採用せず、垂直に延びるガイドレールと、このガイドレールを摺動するスライダとを有するものを採用することもできる。
 さらに、実施例1~3では、駆動手段として、水平アーム15や第1、2リンク19、21等を水平に揺動させるためだけに駆動源を採用したが、工作手段を昇降させるために駆動源を採用することもできる。これらの駆動源としては、サーボモータに限定されず、ステッピングモータ、サーボシリンダ等を採用することもできる。
 また、実施例1~3では、目標座標をxy平面上の座標(x,y)としたが、目標座標を三次元の座標(x,y,z)とすることも可能である。
 さらに、実施例1~3では、ナットランナー9やサーボプレス10の現在座標P(x,y)を検出するために、第1、2位置センサ5a、7aをサーボプレス10に設けたが、ナットランナー9やサーボプレス10に位置センサを設けてこれらの現在座標を検出してもよい。また、作業場に工作手段を撮影可能なカメラを設け、このカメラによって工作手段の現在座標を検出してもよい。
 本発明は、締結装置、加圧装置等に利用可能である。
 W…ワーク
 9d、10a…作用部(9d…ソケット)
 9、10…工作手段(9…ナットランナー、10…サーボプレス)
 3…リンク機構
 5、7…駆動手段(第1、2サーボモータ)
 P(x,y)…現在座標
 5a、7a…現在座標検出手段(第1、2位置センサ)
 A(x1,y1)、B(x2,y2)、C(x3,y3)…目標座標
 43…記憶手段(記憶装置)
 41…制御手段(コントローラ)
 29…継続停止検知手段(ハンドルSW)
 S6~9…駆動継続停止部
 33…操作力検知手段(力センサ)
 S12~17…第1駆動速度変更部
 61…作動状態検知手段(電流センサ)
 S8、41~44…第2駆動速度変更部
 S10、11…ブレーキ部
 S18、19…位置決め部
 9c…回転軸
 9…ナットランナー
 10…サーボプレス

Claims (7)

  1.  ワークに対して作用可能な作用部を有する工作手段と、
     前記工作手段を保持しつつ前記工作手段の移動を可能とするリンク機構と、
     前記工作手段を移動させるために前記リンク機構を駆動する駆動手段と、
     前記工作手段の現在座標を検出する現在座標検出手段と、
     前記作用部を前記ワークに対して作用させるために前記工作手段を位置させる目標座標を記憶する記憶手段と、
     前記工作手段を前記現在座標から前記目標座標まで移動させるために前記駆動手段を制御する制御手段とを備え、
     前記工作手段に設けられ、作業者の操作入力が継続的に行われていれば継続信号を生じ、前記操作入力が継続的に行われていなければ停止信号を生じる継続停止検知手段をさらに備え、
     前記制御手段は、前記継続信号によって前記駆動手段を駆動し、前記停止信号によって前記駆動手段を停止させる駆動継続停止部を有することを特徴とする工作装置。
  2.  前記工作手段に設けられ、前記作業者の操作力を検知する操作力検知手段をさらに備え、
     前記制御手段は、前記操作力検知手段の出力信号によって前記駆動手段の駆動速度を変更する第1駆動速度変更部を有する請求項1記載の工作装置。
  3.  前記駆動手段を作動させる物理量を検知する作動状態検知手段をさらに備え、
     前記制御手段は、前記作動状態検知手段の出力信号によって前記駆動手段の駆動速度を変更する第2駆動速度変更部を有する請求項1又は2記載の工作装置。
  4.  前記制御手段は、前記工作手段が前記目標座標近傍に位置すれば前記工作手段が前記目標座標に収束するように前記駆動手段を制御するブレーキ部を有する請求項1乃至3のいずれか1項記載の工作装置。
  5.  前記制御手段は、前記工作手段が前記目標座標に収束すれば位置決め信号を生じる位置決め部を有する請求項4記載の工作装置。
  6.  前記工作手段は、回転駆動可能な回転軸を有し、前記作用部は締結具を係合可能であり、前記作用部が軸方向に直進しつつ前記回転軸の回転によって前記締結具を前記ワークに対して締結可能なナットランナーである請求項1乃至5のいずれか1項記載の工作装置。
  7.  前記工作手段は、サーボモータによって回転駆動可能な回転軸を有し、前記作用部が前記回転軸の回転によって軸方向に直進して前記ワークに対して押圧可能なサーボプレスである請求項1乃至5のいずれか1項記載の工作装置。
PCT/JP2015/074822 2015-01-09 2015-09-01 工作装置 WO2016111041A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201580068176.3A CN107428007B (zh) 2015-01-09 2015-09-01 工作装置
JP2016568272A JP6545195B2 (ja) 2015-01-09 2015-09-01 工作装置
US15/542,316 US10723021B2 (en) 2015-01-09 2015-09-01 Manufacturing device

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2015003296 2015-01-09
JP2015-003296 2015-01-09

Publications (1)

Publication Number Publication Date
WO2016111041A1 true WO2016111041A1 (ja) 2016-07-14

Family

ID=56355754

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2015/074822 WO2016111041A1 (ja) 2015-01-09 2015-09-01 工作装置

Country Status (4)

Country Link
US (1) US10723021B2 (ja)
JP (1) JP6545195B2 (ja)
CN (1) CN107428007B (ja)
WO (1) WO2016111041A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021154473A (ja) * 2020-03-30 2021-10-07 川田テクノロジーズ株式会社 作業ロボット

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018075672A (ja) * 2016-11-10 2018-05-17 セイコーエプソン株式会社 制御装置、ロボットおよびロボットシステム
CN206677527U (zh) * 2017-01-20 2017-11-28 上海蔚来汽车有限公司 自动加解锁装置
CN110355768B (zh) * 2019-07-30 2020-07-31 南京涵曦月自动化科技有限公司 一种复杂狭窄舱内结构探测清除作业机器人
KR20210157766A (ko) 2020-06-22 2021-12-29 현대자동차주식회사 체결 장치의 작동 방법 및 체결 장치

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0732230A (ja) * 1993-07-20 1995-02-03 Mitsubishi Motors Corp 複数ワークの組み付け方法
JP2005118959A (ja) * 2003-10-17 2005-05-12 Toyoda Mach Works Ltd 作業支援装置、作業支援方法、位置決め作業支援装置およびパワーアシスト作業支援装置
JP2005193339A (ja) * 2004-01-08 2005-07-21 Honda Motor Co Ltd アシスト搬送方法及びその装置
JP2009034754A (ja) * 2007-07-31 2009-02-19 Toyota Motor Corp パワーアシスト装置およびその制御方法

Family Cites Families (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4221516A (en) * 1978-05-31 1980-09-09 Central Research Laboratories, Inc. Master-slave manipulator
US4265147A (en) * 1979-11-05 1981-05-05 D. W. Zimmerman Mfg., Inc. Working pit with articulated tool arm assembly
JPS58211890A (ja) 1982-05-31 1983-12-09 松下電器産業株式会社 ロボツトの関節装置
CA2032182C (en) * 1989-12-20 1996-05-14 Katuo Kotake Method of and apparatus for assembling exterior parts of a motorcar
US5580035A (en) * 1992-09-21 1996-12-03 The Boeing Company Clamp
EP0629469B1 (en) * 1992-12-04 1998-03-18 Toyota Jidosha Kabushiki Kaisha Automatic assembly apparatus
JPH11170201A (ja) * 1997-12-10 1999-06-29 Amitec Corp 走行丸鋸盤
JP4342748B2 (ja) 2001-05-22 2009-10-14 三洋機工株式会社 ねじ締付方法及び装置
JP2003311555A (ja) * 2002-04-25 2003-11-05 Okuma Corp ネジ締め装置
US7578052B2 (en) * 2003-03-10 2009-08-25 Durr Systems, Inc. Valve stem installation system and method of installing the valve stem
JP4048142B2 (ja) 2003-03-27 2008-02-13 三洋機工株式会社 アーム式ロボット
CA2530372A1 (en) 2003-06-25 2005-01-06 Honda Motor Co., Ltd. Assist transportation method and device
JP4137932B2 (ja) 2005-10-28 2008-08-20 ファナック株式会社 ロボット制御装置
EP3530420B1 (en) * 2006-03-03 2023-09-06 Universal Robots A/S Joint for a robot
US7673384B2 (en) * 2006-04-27 2010-03-09 Genesis Systems Group, Llc Nut runner and hexabot robot
KR100837928B1 (ko) * 2006-10-10 2008-06-13 현대자동차주식회사 나사체결 작업용 지그 장치
JP4367666B2 (ja) * 2007-11-09 2009-11-18 トヨタ自動車株式会社 ねじ締付装置
JP4443615B2 (ja) 2008-02-27 2010-03-31 トヨタ自動車株式会社 パワーアシスト装置及びその制御方法
US20110160905A1 (en) * 2008-09-03 2011-06-30 Honda Motor Co., Ltd. Workpiece mounting system, workpiece mounting method, sunroof unit holding device, and sunroof unit holding method

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0732230A (ja) * 1993-07-20 1995-02-03 Mitsubishi Motors Corp 複数ワークの組み付け方法
JP2005118959A (ja) * 2003-10-17 2005-05-12 Toyoda Mach Works Ltd 作業支援装置、作業支援方法、位置決め作業支援装置およびパワーアシスト作業支援装置
JP2005193339A (ja) * 2004-01-08 2005-07-21 Honda Motor Co Ltd アシスト搬送方法及びその装置
JP2009034754A (ja) * 2007-07-31 2009-02-19 Toyota Motor Corp パワーアシスト装置およびその制御方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
TORU TSUMUGIWA ET AL.: "Ningen to Robot no Rikigakuteki Sogo Sayo ni Okeru Dotokusei Taiiki no Kahen Seigyo o Jitsugen suru Device no Kaihatsu", DAI 30 KAI ANNUAL CONFERENCE OF THE ROBOTICS SOCIETY OF JAPAN YOKOSHU DVD -ROM, 17 September 2012 (2012-09-17) *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021154473A (ja) * 2020-03-30 2021-10-07 川田テクノロジーズ株式会社 作業ロボット

Also Published As

Publication number Publication date
CN107428007A (zh) 2017-12-01
US20180272532A1 (en) 2018-09-27
US10723021B2 (en) 2020-07-28
JPWO2016111041A1 (ja) 2017-10-19
CN107428007B (zh) 2020-10-30
JP6545195B2 (ja) 2019-07-17

Similar Documents

Publication Publication Date Title
WO2016111041A1 (ja) 工作装置
US9393687B2 (en) Method for programming an industrial robot and industrial robot
JP4277683B2 (ja) ロボット
KR101779323B1 (ko) 매니퓰레이터를 제어하기 위한 방법 및 장치
JP6055014B2 (ja) 物または人との接触を検知する機能を有するロボット制御装置
US6222338B1 (en) Method and apparatus for the direct teaching of automatic machines
US20120143371A1 (en) Industrial Robot And A Method For Adjusting A Robot Program
US20110313573A1 (en) Method and device for command input in a controller of a manipulator
US20070118249A1 (en) Robot and multiple robot control method
JP5741617B2 (ja) ロボット装置
DK2492062T3 (en) industrial Robot
CN109648585B (zh) 监视作业工具的移动方向的控制装置
JP2018069410A (ja) 学習制御機能を備えたロボット制御装置
JP2016168650A5 (ja)
CN107866800A (zh) 机器人控制装置、机器人以及机器人系统
JP6693939B2 (ja) ロボットシステム
US11433531B2 (en) Robot system and method for controlling robot
WO2015097102A1 (de) Verfahren zum automatisierten montieren an einem montagearbeitsplatz, sowie zugehöriger automatisierter montagearbeitsplatz
JP3632268B2 (ja) ロボットの直接教示装置
CN208215399U (zh) 一种机械臂关节中空谐波减速机穿线保护套
US20210260750A1 (en) Method to Modify a Program for Robotic Welding
US11872697B2 (en) Collaborative device with optimised control
US20210237261A1 (en) Teaching method and robot system
CN108475051B (zh) 用于在工业机器人的编程期间对准工具的方法和系统
JP6712723B2 (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: 15876914

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2016568272

Country of ref document: JP

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 15542316

Country of ref document: US

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 15876914

Country of ref document: EP

Kind code of ref document: A1