WO2022054674A1 - キサゲ加工を行うロボットシステム、方法、及びコンピュータプログラム - Google Patents

キサゲ加工を行うロボットシステム、方法、及びコンピュータプログラム Download PDF

Info

Publication number
WO2022054674A1
WO2022054674A1 PCT/JP2021/032167 JP2021032167W WO2022054674A1 WO 2022054674 A1 WO2022054674 A1 WO 2022054674A1 JP 2021032167 W JP2021032167 W JP 2021032167W WO 2022054674 A1 WO2022054674 A1 WO 2022054674A1
Authority
WO
WIPO (PCT)
Prior art keywords
scraper
robot
processor
scraping
pressing force
Prior art date
Application number
PCT/JP2021/032167
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 CN202180054527.0A priority Critical patent/CN116056840A/zh
Priority to DE112021004741.8T priority patent/DE112021004741T5/de
Priority to JP2022547531A priority patent/JP7469487B2/ja
Priority to US18/023,522 priority patent/US20230311317A1/en
Publication of WO2022054674A1 publication Critical patent/WO2022054674A1/ja

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/085Force or torque sensors
    • 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
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • B25J11/005Manipulators for mechanical processing tasks
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • B25J11/005Manipulators for mechanical processing tasks
    • B25J11/0055Cutting
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1633Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B26HAND CUTTING TOOLS; CUTTING; SEVERING
    • B26DCUTTING; DETAILS COMMON TO MACHINES FOR PERFORATING, PUNCHING, CUTTING-OUT, STAMPING-OUT OR SEVERING
    • B26D3/00Cutting work characterised by the nature of the cut made; Apparatus therefor
    • B26D3/08Making a superficial cut in the surface of the work without removal of material, e.g. scoring, incising
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/42Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/39Robotics, robotics to robotics hand
    • G05B2219/39529Force, torque sensor in wrist, end effector
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/45Nc applications
    • G05B2219/45058Grinding, polishing robot
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/45Nc applications
    • G05B2219/45096Polishing manipulator

Definitions

  • the present invention relates to a robot system, a method, and a computer program for scraping.
  • Patent Document 1 A robot that performs scraping is known (for example, Patent Document 1).
  • the scraper By moving the scraper along the surface and toward the surface by the robot, the scraper is brought into contact with the surface in an inclined trajectory so as to form a sharp angle with respect to the surface, and the scraper is brought to the surface.
  • the position of the robot is controlled so that the pressing force that the robot presses against the surface of the scraper has a predetermined magnitude, and the scraper is moved along the scraper by the robot to perform shaving processing. Execute.
  • a method of performing a scraping process to flatten the surface by using a robot that moves a scraper that scrapes the surface of the work is to move the scraper in a direction along the surface by the robot.
  • the scraper By moving the scraper toward the surface together, the scraper is brought into contact with the surface in an inclined trajectory so as to form a sharp angle, and the robot brings the scraper to the surface while the scraper is in contact with the surface.
  • the position of the robot is controlled so that the pressing force is a predetermined magnitude, and the scraper is moved by the robot in a direction along the scraper to execute the shaving process.
  • the robot can perform scraping with the same quality as a skilled person.
  • FIG. 3 is an enlarged view of the scraper shown in FIG. 1 as viewed from the arrow B in FIG.
  • FIG. 3 is an enlarged view of the scraper shown in FIG. 3 as viewed from the arrow D in FIG.
  • the state where the scraper shown in FIG. 1 is pressed against the surface of the work is shown.
  • An example of teaching points set for the surface of the work is shown.
  • the state of the handle of the scraper during scraping is schematically shown.
  • the recess formed by scraping is schematically shown.
  • the recess formed by scraping is schematically shown. It shows the time-varying characteristics of the pressing force that presses the scraper against the surface of the work while the expert is performing scraping.
  • the time-varying characteristic of the pressing force that the robot presses the scraper against the surface of the work when the robot system shown in FIG. 1 performs scraping is shown.
  • An example of the operation flow of the robot system shown in FIG. 1 is shown.
  • An example of the flow of step S5 in FIG. 14 is shown.
  • Another example of the time-varying characteristic of the pressing force that the robot presses the scraper against the surface of the work when the robot system shown in FIG. 1 performs scraping is shown.
  • Other examples of teaching points set for the surface of the work are shown.
  • step S5 in FIG. 14 Shows the trajectory of the scraper actually moving during scraping.
  • Yet another example of the time-varying characteristic of the pressing force by which the robot presses the scraper against the surface of the work when the robot system shown in FIG. 1 performs scraping is shown. It shows the trajectory of the scraper actually moving when scraping is performed on a relatively thin workpiece.
  • the time-varying characteristic of the pressing force that the robot presses the scraper against the surface of the work when scraping is executed on the work shown in FIG. 21 is shown.
  • the time-varying characteristic of the pressing force that the robot presses the scraper against the surface of the work when scraping is executed on the work shown in FIG. 21 is shown.
  • FIG. 24 shows the time-varying characteristics of the pressing force that the robot presses the scraper against the surface of the work when scraping is performed on the work shown in FIG. 24. Yet another example of the teaching points set for the surface of the work is shown.
  • the same elements are designated by the same reference numerals, and duplicate description will be omitted.
  • the x-axis plus direction of the robot coordinate system C1 in the figure may be referred to as the right side, the y-axis plus direction as the front side, and the z-axis plus direction as the upper side.
  • the robot system 10 is a system for scraping in order to flatten the surface of the work.
  • Scraping is a process of scraping the surface of the fine irregularities formed on the surface of the work in order to keep the dimensions of the work in the thickness direction within a predetermined range (for example, on the order of ⁇ m).
  • This minute unevenness functions as a so-called "oil pool” for storing lubricating oil.
  • scraping is performed by roughing to reduce the fine irregularities formed when the surface of the work is machined by a milling machine or the like to the first dimension (for example, 10 ⁇ m) or less, and after the roughing, the fine irregularities. Includes a finishing process to reduce the size to a second dimension (eg, 5 ⁇ m) that is smaller than the first dimension.
  • the robot system 10 includes a robot 12, a force sensor 14, a scraper 16, and a control device 18.
  • the robot 12 is a vertical articulated robot and has a robot base 20, a swivel body 22, a lower arm portion 24, an upper arm portion 26, and a wrist portion 28.
  • the robot base 20 is fixed on the floor of the work cell.
  • the swivel body 22 is provided on the robot base 20 so as to be able to swivel around the vertical axis.
  • the lower arm portion 24 is rotatably provided on the swivel body 22 around a horizontal axis
  • the upper arm portion 26 is rotatably provided on the tip portion of the lower arm portion 24.
  • the wrist portion 28 has a wrist base 28a rotatably provided at the tip of the upper arm portion 26 and a wrist flange 28b provided on the wrist base 28a so as to be rotatable around the wrist axis A1. ..
  • the wrist flange 28b constitutes the hand portion of the robot 12.
  • Servo motors 34 are provided on each component of the robot 12 (robot base 20, swivel body 22, lower arm 24, upper arm 26, wrist 28). These servomotors 34 rotate each movable element of the robot 12 (turning body 22, lower arm 24, upper arm 26, wrist 28, hand 28b) around the drive shaft in response to a command from the control device 18. Move it. As a result, the robot 12 can move the scraper 16 and arrange it at an arbitrary position and posture.
  • the force sensor 14 detects the pressing force F at which the robot 12 presses the scraper 16 against the surface of the work.
  • the force sensor 14 is a 6-axis force sensor having a cylindrical main body portion and a plurality of strain gauges provided on the main body portion, and is inserted between the hand portion 28b and the scraper 16. ing.
  • the force sensor 14 is arranged so that its central axis coincides with the wrist axis A1.
  • the scraper 16 is fixed to the tip of the force sensor 14 and scrapes the surface of the work for scraping.
  • the scraper 16 has a flexible handle portion 30 and a blade portion 32 fixed to the tip end portion of the handle portion 30.
  • the base end portion of the handle portion 30 is fixed to the tip end portion of the force sensor 14, and is connected to the hand portion 28b of the robot 12 via the force sensor 14.
  • the handle portion 30 extends linearly from the tip end portion of the force sensor 14 along the axis A2.
  • the blade portion 32 extends along the axis A2 from its base end 32b to the tip end 32a.
  • the axis A2 may be substantially orthogonal to the wrist axis A1.
  • the tip 32a of the blade portion 32 is curved so as to bulge outward from both ends in the width direction toward the center when viewed from the upper side (direction of arrow B in FIG. 1). is doing. Further, as shown in FIG. 4, the tip 32a of the blade portion 32 has a substantially rectangular outer shape when viewed from the front side (direction of arrow D in FIG. 3).
  • the scraper 16 presses the tip 32a of the blade portion 32 against the surface of the work, and scrapes the surface with the tip 32a.
  • the control device 18 controls the operation of the robot 12.
  • the control device 18 is a computer having a processor 40, a memory 42, an I / O interface 44, an input device 46, and a display device 48.
  • the processor 40 is communicably connected to the memory 42, the I / O interface 44, the input device 46, and the display device 48 via the bus 50, and is used to perform the Kisage processing while communicating with these components. Perform arithmetic processing.
  • the memory 42 has a RAM, a ROM, or the like, and temporarily or permanently stores various data.
  • the I / O interface 44 has, for example, an Ethernet (registered trademark) port, a USB port, an optical fiber connector, or an HDMI (registered trademark) terminal, and data is transmitted to and from an external device under a command from the processor 40. Communicate by wire or wirelessly.
  • each servomotor 34 and the force sensor 14 of the robot 12 are communicably connected to the I / O interface 44.
  • the input device 46 has a keyboard, mouse, touch panel, etc., and receives data input from the operator.
  • the display device 48 has a liquid crystal display, an organic EL display, or the like, and displays various data visually under a command from the processor 40.
  • the input device 46 or the display device 48 may be integrated into the housing of the control device 18, or may be externally attached to the housing separately from the housing of the control device 18. ..
  • the robot coordinate system C1 is set in the robot 12.
  • the robot coordinate system C1 is a coordinate system for controlling the operation of each movable element of the robot 12, and is fixed to the robot base 20.
  • the robot coordinate system C1 is set with respect to the robot 12 so that its origin is located at the center of the robot base 20 and its z-axis coincides with the swivel axis of the swivel cylinder 22. There is.
  • the tool coordinate system C2 is set in the scraper 16.
  • the tool coordinate system C2 is a coordinate system that defines the position and posture of the scraper 16 (or the hand portion 28b) in the robot coordinate system C1.
  • the origin (so-called TCP) of the tool coordinate system C2 is arranged at the center of the tip 32a of the blade portion 32 in a state where the handle portion 30 is not bent, and its z-axis is the axis A2 (so-called TCP).
  • TCP the origin of the tool coordinate system C2
  • it is set with respect to the scraper 16 so as to be parallel to the normal direction of the curved surface of the tip 32a at the center of the tip 32a.
  • the processor 40 of the control device 18 sets the tool coordinate system C2 in the robot coordinate system C1 and arranges the scraper 16 at the position and the posture represented by the set tool coordinate system C2. Generates a command to each servomotor 34 of the robot 12. In this way, the processor 40 can position the scraper 16 at an arbitrary position and orientation in the robot coordinate system C1.
  • the sensor coordinate system C3 is set in the force sensor 14.
  • the sensor coordinate system C3 is a coordinate system that defines the direction of the force acting on the force sensor 14.
  • the origin of the sensor coordinate system C3 is located at the center of the force sensor 14, and its z-axis coincides with the wrist axis A1 (or its x-axis is parallel to the z-axis of the tool coordinate system C2). Is set for the force sensor 14.
  • FIG. 5 shows a state in which the robot 12 brings the tip 32a of the blade portion 32 of the scraper 16 into contact with the surface Q1 of the work W1.
  • the robot 12 presses the tip 32a of the scraper 16 against the surface Q1 with a pressing force F in a direction orthogonal to the surface Q1, the reaction force F'of the pressing force F passes from the surface Q1 via the scraper 16. It is applied to the force sensor 14.
  • Each of the strain gauges of the force sensor 14 transmits the detection data corresponding to the force acting on the force sensor 14 to the control device 18.
  • the processor 40 acts on the force sensor 14 at this time, and the force f in the x-axis, y-axis, and z-axis directions of the sensor coordinate system C3.
  • the torque ⁇ in the directions around the x-axis, around the y-axis, and around the z-axis.
  • the processor 40 has a magnitude of reaction force F'acting on the tip 32a of the blade portion 32 in a direction orthogonal to the surface Q1 based on the force f and the torque ⁇ and the state data CD of the scraper 16 at this time. Is calculated.
  • the state data CD is, for example, an angle ⁇ 1 between the axis A2 and the surface Q1, a distance d from the wrist axis A1 (or the origin of the sensor coordinate system C3) to the tip 32a of the blade 32, and a tool coordinate system in the robot coordinate system C1. It includes at least one of data indicating the position and orientation of C2 (or the sensor coordinate system C3) and bending data of the handle portion 30 (for example, the bending amount or elastic modulus of the handle portion 30).
  • the force sensor 14 detects the reaction force F'as the pressing force F
  • the control device 18 obtains the magnitude of the pressing force F (reaction force F') based on the detection data of the force sensor 14. Can be done.
  • a plurality of teaching points TP 1 , TP 2 , TP 3 , and TP 4 for which the tip 32a (that is, TCP) of the scraper 16 should be positioned in order to perform scraping are the surfaces of the work W1. It is set in advance according to Q1.
  • the teaching point TP 2 is set at a position separated to the lower right of the teaching point TP 1
  • the teaching point TP 3 is set at a position separated to the right of the teaching point TP 2 . ..
  • the positions of the teaching points TP 2 and TP 3 in the robot coordinate system C1 in the z-axis direction are substantially the same as each other.
  • the teaching point TP 4 is set at a position separated to the upper right from the teaching point TP 3 .
  • the processor 40 When scraping, the processor 40 starts position control. Specifically, after the start of position control, the processor 40 generates a position control command PC for sequentially moving the scraper 16 to a plurality of teaching points TP n by the robot 12. Specifically, the processor 40 generates a position control command PC n for moving the tip 32a of the scraper 16 from the teaching point TP n to the teaching point TP n + 1 .
  • the processor 40 positions the scraper 16 in the order of teaching points TP 1 ⁇ TP 2 ⁇ TP 3 ⁇ TP 4 by operating each servomotor 34 of the robot 12 according to the position control command PC n . By this position control, the processor 40 moves the scraper 16 (specifically, the tip 32a) along the movement path MP defined by the plurality of teaching points TP n .
  • the surface Q1 of the work W1 is substantially parallel to the xy plane of the robot coordinate system C1, and the direction MD of the movement path MP is the robot coordinate system C1. It is assumed that it is substantially parallel to the xz plane.
  • the position control command PC n is a speed command PC V_n (first speed command) that defines a speed VP_n when the scraper 16 (that is, the hand portion 28b of the robot 12) is moved from the teaching point TP n to the teaching point TP n + 1 . ).
  • the processor 40 After the start of position control, when the scraper 16 reaches the teaching point TP 2 in FIG. 6, the processor 40 starts force control.
  • the teaching point TP 2 is set so that when the tip 32a of the scraper 16 is arranged at the teaching point TP 2 , the tip 32a is separated upward from the surface Q1.
  • the processor 40 controls the pressing force F that the robot 12 presses the scraper 16 against the surface Q1 of the work W1 to the target value FT based on the detection data of the force sensor 14.
  • the position of the hand portion 28b (or TCP) is controlled.
  • the processor 40 controls the pressing force F (specifically, the reaction force F') acquired based on the detection data of the force sensor 14 to the target value FT, so that the robot 12 A force control command FC for controlling the position of the hand portion 28b (TCP) is generated. Then, the processor 40 adds the force control command FC to the position control command PC n to operate the servomotor 34 of the robot 12.
  • the processor 40 moves the scraper 16 (or the hand portion 28b) in the direction MD according to the position control command PC n , and approaches or separates the scraper 16 from the surface Q1 of the work W1 according to the force control command FC.
  • Move in the direction that is, the z-axis direction of the robot coordinate system C1).
  • the force control command FC has a speed command FC V (second speed command) that defines the speed at which the scraper 16 is moved in the z-axis direction of the robot coordinate system C1.
  • the processor 40 When the scraper 16 reaches the teaching point TP 2 , the processor 40 generates a speed command PC V_2 as a position control command PC 2 for moving the scraper 16 from the teaching point TP 2 to the teaching point TP 3 , and also performs force control.
  • the speed command FC V_0 is generated as the command FC.
  • FIG. 7 schematically shows the speed command PC V_2 and the speed command FC V_0 generated by the processor 40 when the scraper 16 reaches the teaching point TP 2 .
  • the processor 40 operates the robot 12 according to the speed command PC V_2 to move the scraper 16 from the teaching point TP 2 to the teaching point TP 3 and correspond to the speed command PC V_2 ( Specifically, it is moved in the direction MD at the speed VP_2 (which matches).
  • the processor 40 generates the speed command FC V_0 and adds it to the speed command PC V_2 to the servomotor 34, so that the scraper 16 is directed toward the surface Q1 (that is, downward) to the speed command FC V_0 .
  • the robot 12 moves the scraper 16 in the direction MD'in FIG. 7 after passing through the teaching point TP 2 .
  • FIG. 8 shows the orbit TR actually followed by the scraper 16 (specifically, the tip 32a) in scraping with a solid line.
  • the scraper 16 moves toward the surface Q1 on an orbit TR inclined so as to form an acute angle ⁇ 2 with respect to the surface Q1, and abuts on the surface Q1 at the position P1.
  • the processor 40 moves the scraper 16 in the direction MD (that is, to the right) along the surface Q1 according to the position control command PC 2 , and presses the pressing force F by force control.
  • the speed command FC V_1 is generated as the force control command FC for controlling to the target value FT .
  • the position of the hand portion 28b of the robot 12 is displaced in the z-axis direction of the robot coordinate system C1 at the speed VF_1 corresponding to the speed command FC V_1 .
  • the maximum value of the velocity command FC V_1 (that is, the velocity VF_1 ) generated while the scraper 16 is in contact with the surface Q1 is the velocity command FC V_1 generated before the scraper 16 is in contact with the surface Q1 (that is, the velocity VF_1 ). That is, it can be set to be larger than the speed VF_0 ).
  • FIG. 9 shows the state of the scraper 16 during scraping.
  • the robot 12 presses the tip 32a of the scraper 16 against the surface Q1 with a pressing force F, whereby the handle portion 30 of the scraper 16 is curved so as to bulge downward. And bend.
  • the target value FT for force control is set as a value at which the handle portion 30 can be bent during scraping.
  • the processor 40 moves the scraper 16 to the teaching point TP 4 . 3 is generated.
  • the processor 40 moves the hand portion 28b to the upper right by operating the robot 12 in accordance with the position control command PC 3 .
  • the scraper 16 moves upward to the right on the orbit TR inclined so as to form an acute angle ⁇ 3 with respect to the surface Q1 of the work W1, and the tip 32a of the scraper 16 separates from the surface Q1 at the position P2. In this way, scraping is completed.
  • a concave portion R having a curved shape is formed on the surface Q1 so as to extend to the right from the position P1 to the position P2. ..
  • the recess R has a length x2 in the x - axis direction of the robot coordinate system C1 and a depth E in the z-axis direction.
  • the depth E of the recess R is enlarged and shown in FIGS. 10 and 11 for easy understanding, it is understood that the actual depth E of the recess R is about 10 ⁇ m or less. I want to be.
  • the processor 40 generates the speed commands PC V_2 and FC V_0 so that the acute angle ⁇ 2 described above is within a predetermined range.
  • the present inventor causes a scraper 16 expert to move the blade portion 32 of the scraper 16 with respect to the surface Q1 of the work W1 in an orbit at an angle of 15 ° to 35 ° to bring it into contact with the surface Q1. I got the finding that there is.
  • the present inventor has acquired data on the time-varying characteristics of the pressing force FR that presses the blade portion 32 of the scraper 16 against the surface Q1 of the work W1 while the skilled worker is continuously performing scraping.
  • This time change characteristic is shown in FIG. From the time-varying characteristics shown in FIG. 12, the present inventor has a pressing force FR for which a skilled worker presses the blade portion 32 against the surface Q1 in one scraping (that is, forming one concave portion R ). While acquiring the size (peak value of the time change characteristic), it was found that the speed at which the blade portion 32 is moved by the expert during scraping is about 100 [mm / sec].
  • the distances in the x-axis and z-axis directions of the robot coordinate system C1 between the teaching point TP 2 and the position P1 in FIG. 8 are the distances x 1 and z 1 , respectively, the distances x 1 and z 1 , the speed command PC V_2 (speed VP_2 ), and the speed command FC V_0 (speed VF_0 ) satisfy the following equation (1).
  • the acute angle ⁇ 2 ⁇ 26.6 ° can be determined from the equation (2).
  • the speed VP_2 that is, the speed command PC V_2
  • the speed VF_0 that is, the speed command FC V_0
  • the target value FT is set to a value (for example, 100 [N]) corresponding to the material of the work W1 and the target depth E of the recess R.
  • the machining condition MC includes a distance x 1 , a distance z 1 , an acute angle ⁇ 2, a speed VF_0 (speed command FC V_0 ), and a speed VP_2 (speed command PC V_2 ).
  • the present inventor observes scraping by a skilled person, and as a result of diligent examination, controls the above-mentioned acute angle ⁇ 2 to be within the range of, for example, 15 ° to 35 ° if the processing condition MC is appropriately set. It has been found that the pressing force F can be controlled so as to have the same time-changing characteristics as in FIG. 12, and therefore, scraping can be performed by the robot 12 with the same quality as that of a skilled worker.
  • FIG. 13 when the processor 40 operates the robot 12 according to a predetermined machining condition MC to continuously perform scraping (that is, a plurality of recesses R are formed), the blade portion 32 of the scraper 16 is subjected to the work W1.
  • the time-varying characteristic of the pressing force F pressed against the surface Q1 is shown.
  • the pressing force F in one scraping is set to have the same magnitude of the time change characteristic as that of FIG. Can be controlled.
  • the processor 40 speeds the position of the hand portion 28b of the robot 12 by generating a force control command FC (speed command FC V_1 ). It is displaced downward by VF_1 , whereby the pressing force F is rapidly increased.
  • FC speed command FC V_1
  • the processor 40 generates the position control command PC 2 (speed command PC V_2 ) for moving the scraper 16 from the teaching point TP 2 to the teaching point TP 3 as described above, but at the teaching point TP 3 .
  • the position control command PC 2 becomes dominant over the force control command FC, and the processor 40 starts from the surface Q1 of the work W1 before reaching the position corresponding to the teaching point TP3 with the scraper 16 ( hand portion 28b). It will be moved away (ie, upward).
  • the magnitude of the pressing force F sharply decreases after reaching the peak value FP shown in FIG.
  • the processor 40 moves the scraper 16 upward before the pressing force F reaches the target value FT of the force control. Therefore, in the present embodiment, the peak value FP is smaller than the target value FT .
  • the processor 40 operates the robot 12 according to the position control commands PC 2 and PC 3 to move the scraper 16 upward to the right along the orbit TR inclined so as to form an acute angle ⁇ 3, and the scraper 16 moves.
  • the pressing force F becomes zero when the surface Q1 is separated from the surface Q1 at the position P2.
  • the processor 40 controls the pressing force F in scraping so as to have a predetermined magnitude as the characteristic shown in FIG.
  • the "predetermined magnitude" of the pressing force F includes not only the peak value FP but also the time change characteristic shown in FIG. Further, as described above, in the present embodiment, the peak value FP of the pressing force F is smaller than the target value FT of the force control. This peak value FP corresponds to the target value FT and changes depending on the target value FT . In other words, the peak value FP can be controlled by the target value FT .
  • the processor 40 executes the flow shown in FIG. 14 according to the computer program CP stored in the memory 42 in advance.
  • the flow shown in FIG. 14 is started, for example, when the control device 18 is activated.
  • step S1 the processor 40 determines whether or not the input of the machining condition MC has been accepted. For example, the processor 40 sets the above-mentioned distance x 1 , distance z 1 , sharp angle ⁇ 2, speed VF_0 (speed command FC V_0 ), speed VP_2 (speed command PC V_2 ), and target value FT as the processing condition MC.
  • the image data of the input screen for input is generated and displayed on the display device 48 of the control device 18.
  • the operator operates the input device 46 of the control device 18 while visually recognizing the input screen displayed on the display device 48, and sets the machining condition MC as a distance x 1 , a distance z 1 , a sharp angle ⁇ 2, and a speed VF_0 (speed).
  • Input at least three data of the command FC V_0 ) and the speed VP_2 (speed command PC V_2 ), and input the target value FT .
  • the processor 40 receives the input data of the machining condition MC from the input device 46, it determines YES and proceeds to step S2, while when it does not accept the input data of the machining condition MC, it determines NO and proceeds to step S3. move on.
  • step S2 the processor 40 determines the machining condition MC.
  • step S3 the processor 40 determines whether or not the scraper processing start command has been received from the operator, the host controller, or the computer CP.
  • the processor 40 determines YES when the scraper machining start command is received and proceeds to step S4, while the processor 40 determines NO when the scraper machining start command is not received and proceeds to step S6.
  • step S4 the processor 40 determines whether or not all the machining condition MCs have been set. Specifically, the processor 40 has all of the distance x 1 , the distance z 1 , the acute angle ⁇ 2, the speed VF_0 (speed command FC V_0 ), and the speed VP_2 (speed command PC V_2 ) set as the machining conditions MC. If there is, it is determined as YES, and the process proceeds to step S5. On the other hand, in the processor 40, when at least one of the distance x 1 , the distance z 1 , the acute angle ⁇ 2, the speed VF_0 (speed command FC V_0 ), and the speed VP_2 (speed command PC V_2 ) is not set as the processing condition MC. Determines NO and proceeds to step S7.
  • step S5 the processor 40 performs scraping.
  • step S5 will be described with reference to FIG.
  • step S11 the processor 40 starts position control. Specifically, the processor 40 starts the operation of generating the above-mentioned position control command PC n , and the robot 12 moves the tip 32a of the scraper 16 in the order of teaching points TP 1 ⁇ TP 2 ⁇ TP 3 ⁇ TP 4 . Start the operation to make it.
  • step S12 the processor 40 determines whether or not the scraper 16 has reached the teaching point TP2.
  • the servomotor 34 of the robot 12 is provided with a rotation detector (encoder, Hall element, etc.) that detects the rotation (specifically, the rotation angle or the rotation position) of the servomotor 34.
  • the processor 40 acquires the position data of the scraper 16 (specifically, TCP) in the robot coordinate system C1 based on the feedback from the rotation detector, and from the position data, the scraper 16 reaches the teaching point TP 2 . It can be determined whether or not it has been reached. If the processor 40 determines that the scraper 16 has reached the teaching point TP 2 (that is, YES), the processor 40 proceeds to step S13, while the processor 16 determines that the teaching point TP 2 has not been reached (that is, NO). If so, the step S12 is looped.
  • TCP position data of the scraper 16
  • step S13 the processor 40 starts force control. Specifically, the processor 40 starts the operation of generating the above-mentioned force control command FC, and adds the force control command FC to the position control command PC n to operate the robot 12.
  • the scraper 16 moves toward the surface Q1 of the work W1 along the orbit TR (FIG. 8) inclined at an acute angle ⁇ 2 ⁇ 26.6 °.
  • the acute angle ⁇ 2 can be controlled within a predetermined range (for example, 15 ° to 35 °).
  • step S14 the processor 40 determines whether or not the pressing force F acquired based on the detection data of the force sensor 14 is equal to or higher than a predetermined threshold value Fth (F ⁇ Fth ).
  • This threshold value Fth is predetermined by the operator as a value indicating that the tip 32a of the scraper 16 has come into contact with the surface Q1 of the work W1.
  • F ⁇ Fth the processor 40 determines YES and proceeds to step S15, while when F ⁇ Fth , the processor 40 determines NO and loops step S14.
  • step S15 the processor 40 switches the force control command FC. Specifically, the processor 40 switches the generated force control command FC from the speed command FC V_0 to the speed command FC V_1 . After switching to the speed command FC V_1 , the processor 40 generates the speed command FC V_1 and positions the hand portion 28b of the robot 12 in the robot coordinate system C1 in order to control the pressing force F to the target value FT. It is displaced in the z-axis direction at the velocity VF_1 corresponding to the velocity command FC V_1 . As described above, the maximum value of the speed VF_1 (speed command FC V_1 ) can be larger than the speed VF_1 (speed command FC V_0 ).
  • step S16 the processor 40 determines whether the scraper 16 (or the hand portion 28b) has reached the position corresponding to the teaching point TP 4 .
  • the processor 40 executes the position control and the force control in parallel, the tip 32a of the scraper 16 moves along the trajectory TR shown in FIG. 8, and the teaching point TP. It will pass below 3 and TP 4 .
  • step S16 did the processor 40 match the x-coordinate of the robot coordinate system C1 of the tip 32a (or the hand portion 28b) with the x - coordinate of the teaching point TP4 based on the feedback from the rotation detector described above? Judge whether or not. If the processor 40 determines YES, the processor proceeds to step S17, while if it determines NO, the processor 40 loops step S16.
  • step S16 Before determining YES in step S16, the tip 32a of the scraper 16 separates from the surface Q1 of the work W1 at the position P2 as described above. Then, in step S17, the processor 40 ends the force control and the position control. In this way, one scraping process is completed, and the recess R as shown in FIGS. 10 and 11 is formed on the surface Q1 of the work W1.
  • the processor 40 determines in step S6 whether or not the operation end command has been received from the operator, the host controller, or the computer program CP. When the processor 40 receives the operation end command, it determines YES and terminates the flow shown in FIG. 14, while when it does not accept the operation end command, it determines NO and returns to step S1.
  • step S4 the processor 40 transmits a warning signal in step S7.
  • the processor 40 generates a voice or image warning signal "Please set processing conditions" and outputs it to the operator through a speaker (not shown) or a display device 48 provided in the control device 18. Then, the processor 40 returns to step S1.
  • the processor 40 brings the scraper 16 into contact with the surface Q1 of the work W1 by the robot 12 on the orbit TR inclined at an acute angle ⁇ 2. Then, the processor 40 controls the pressing force F to a predetermined size (FIG. 13) while the scraper 16 is in contact with the surface Q1, and moves the scraper 16 to the right along the surface WS . By doing so, scraping is being carried out. According to this configuration, the robot 12 can perform scraping with the same quality as a skilled worker.
  • the processor 40 executes force control based on the detection data of the force sensor 14 while the scraper 16 is in contact with the surface Q1 of the work W1, so that the hand portion 28b of the robot 12 The position of is controlled in the z-axis direction of the robot coordinate system C1.
  • the pressing force F can be controlled with high accuracy so as to have a predetermined size as the characteristic shown in FIG. 13 during scraping.
  • the time-varying characteristic of the pressing force F when the robot 12 is performing scraping can be brought closer to the time-changing characteristic of the pressing force FR by an expert (FIG. 12), so that the robot 12 executes the scraping. It is possible to more effectively bring the quality of scraping to the quality of skilled workers.
  • the processor 40 moves the scraper 16 from the teaching point TP 2 to the teaching point TP 3 according to the position control command PC 2 (specifically, the speed command PC V_2 ), and also causes the force control command FC. (Specifically, by moving the scraper 16 downward in accordance with the speed command FC V_0 ), the scraper 16 is brought into contact with the surface Q1 of the work W1 by an orbit TR inclined by a sharp angle ⁇ 2.
  • the processor 40 generates the speed commands PC V_2 and FC V_0 so that the acute angle ⁇ 2 is within a predetermined range (for example, 15 ° to 35 °).
  • a predetermined range for example, 15 ° to 35 °.
  • the acute angle ⁇ 2 of the orbit TR can be controlled with high accuracy so as to be within a desired range by the position control command PC 2 (speed command PC V_2 ) and the force control command FC (speed command FC V_0 ). .. This makes it possible to more effectively bring the quality of scraping performed by the robot 12 closer to the quality of a skilled worker.
  • the processor 40 moves the scraper 16 away from the surface Q1 of the work W1 (that is, upward) before the pressing force F reaches the target value FT during the execution of the force control.
  • the scraping process has been completed.
  • the time-varying characteristic of the pressing force F in one scraping (FIG. 13) can be effectively brought close to the time-varying characteristic of the pressing force FR by a skilled worker (FIG. 12).
  • the concave portion R can be formed in a curved shape in which the central portion thereof is concave. This makes it possible to improve the quality of scraping.
  • the scraper 16 when the processor 40 and scraping are being executed, the scraper 16 is separated from the surface Q1 by an orbit TR inclined so as to form an acute angle ⁇ 3 with respect to the surface Q1 of the work W1.
  • the scraping process has been completed.
  • the concave portion R can be formed in a curved shape, so that the quality of scraping can be improved.
  • the acute angle ⁇ 3 includes the positions of the teaching points TP 3 and TP 4 , the moving path MP from the teaching point TP 2 to the teaching point TP 3 , and the moving path MP from the teaching point TP 3 to the teaching point TP 4 . It can be controlled by adjusting the angle of. As an example, this acute angle ⁇ 3 is controlled to be an angle of 14 ° to 20 °.
  • the target value FT for force control is such that the handle portion 30 bends when the blade portion 32 is pressed against the surface Q1 of the work W1 during scraping . (That is, the magnitude of the pressing force F) is defined.
  • the minute vibration of the blade portion 32 generated during scraping due to the bending of the handle portion 30 is absorbed, and the pressing force F can be evenly applied from the blade portion 32 to the surface Q1.
  • the surface of the formed recess R from becoming wavy, so that the quality of scraping can be improved.
  • the posture of the wrist portion may be controlled so as to be.
  • the processor 40 may control the posture of the wrist portion so as to satisfy ⁇ 1 ⁇ 2 (or ⁇ 1> ⁇ 2) (that is, the axis A2 and the direction MD'are non-parallel).
  • the processor 40 moves the scraper 16 upward before the pressing force F reaches the target value FT during the execution of the force control.
  • the present invention is not limited to this, and the processor 40 may move the scraper 16 upward when the pressing force F reaches the target value FT during the execution of the force control.
  • the time change characteristic of the pressing force F is the same as that of FIG. 13, while the peak value FP is the same as the target value FT.
  • the pressing force F so that the peak value FP becomes the same as the target value FT.
  • the processor 40 peaks by increasing the speed command FC V_1 generated by force control after the blade 32 abuts on the surface Q1 of the work W1 (determined to be YES in step S14 above).
  • the pressing force F can also be controlled so that the value FP is the same as the target value FT.
  • the processor 40 continuously performs scraping so that the pressing force F is continuously maintained at the target value FT after the pressing force F reaches the target value FT by force control. good. For example, when the distance x 3 between the teaching point TP 2 and the teaching point TP 3 is set long and the processor 40 executes the flow of FIGS. 14 and 15, the pressing force F is continued to the target value FT . The scraping process will be continued so that it can be maintained.
  • FIG. 16 shows the time-varying characteristics of the pressing force F in such scraping.
  • the processor 40 causes the force control command FC to continuously maintain the pressing force F at the target value FT while the scraper 16 is moved to the right toward the teaching point TP 3 according to the position control command PC 2 .
  • the speed command FC V_1 is generated, and the position of the hand portion 28b of the robot 12 is controlled.
  • the processor 40 moves the scraper 16 upward before reaching the position corresponding to the teaching point TP 3 (specifically, the position below the teaching point TP 3 ), as in the above-described embodiment. Move.
  • the pressing force F sharply decreases, and when the blade portion 32 of the scraper 16 separates from the surface Q1 of the work W1 at the position P2, the pressing force F becomes zero.
  • the processor 40 controls the pressing force F in scraping so as to have a predetermined magnitude as the characteristic shown in FIG.
  • the robot 12 can form the recess R having a relatively long length x 2 with the same quality as that of a skilled worker.
  • the teaching point TP n is not limited to the form shown in FIG. 6, and any number of teaching points may be set for the work W.
  • FIG. 17 shows another form of the teaching point TP n .
  • teaching points TP 1 , TP 2 , TP 3 , TP 4 , and TP 5 are set along the surface Q1 of the work W1.
  • the teaching point TP 4 is arranged to the right of the teaching point TP 3 , and the positions of the teaching points TP 2 , TP 3 , and TP 4 in the robot coordinate system C1 in the z-axis direction are substantially the same.
  • the teaching point TP 5 is arranged on the upper right side of the teaching point TP 4 .
  • step S5 according to the present embodiment will be described with reference to FIG.
  • step S5 the processor 40 executes steps S11 to S16 in the same manner as in the above-described embodiment.
  • the scraper 16 moves from the teaching point TP 1 to the teaching point TP 2 , and then moves toward the surface Q1 of the work W1 on the orbit TR inclined at an acute angle ⁇ 2, and at the position P1. It abuts on the surface Q1.
  • FIG. 20 shows the time change characteristic of the pressing force F when the processor 40 executes the force control in the present embodiment.
  • the pressing force F sharply increases from the time t1 when the scraper 16 comes into contact with the surface Q1 at the position P1 by the force control.
  • the pressing force F reaches the peak value FP at t2 when the scraper 16 reaches the position corresponding to the teaching point TP 3 , and then the scraper 16 (specifically, the scraper 16 (specifically).
  • the tip 32a) reaches the position corresponding to the teaching point TP 4 (specifically, the position below the teaching point TP 4 )
  • the pressing force F is at t 3 (that is, when YES is determined in step S16).
  • Force control command FC (specifically, speed command FC V_1 ) is generated to control the position of the hand portion 28b of the robot 12 so that is zero.
  • the processor 40 generates the position control command PC 3 and the force control command FC so that the scraper 16 is in contact with the surface Q1 of the work W1 at the time point t3.
  • step S21 the processor 40 ends the force control.
  • the processor 40 moves the scraper 16 to the upper right along the orbit TR inclined at an acute angle ⁇ 3 as shown in FIG. 19 by operating the robot 12 according to the position control command PC 4 .
  • the scraper 16 separates from the surface Q1 of the work W1 at the position P2, and scraping is completed.
  • step S22 the processor 40 determines whether or not the scraper 16 has reached the position corresponding to the teaching point TP 5 . If the processor 40 determines YES, the processor proceeds to step S23, while if it determines NO, the processor 40 loops step S22. Then, in step S23, the processor 40 ends the position control.
  • the pressing force F reaches the peak value FP, and at the time t 3 when the scraper 16 reaches the teaching point TP 4 .
  • the force control is executed so that the pressing force F becomes zero.
  • the time change characteristic of the pressing force F shown in FIG. 20 can be controlled in more detail, which is effective for the time change of the pressing force FR when a skilled worker is performing scraping. Can be approached to.
  • the processor 40 may change the force control command according to the thickness H of the work W in the z-axis direction of the robot coordinate system C1. This function will be described below.
  • FIG. 21 shows the actual locus TR'of the scraper 16 when the processor 40 executes the flow shown in FIG. 14 with respect to the work W2 having a thickness H thinner than the work W1 shown in FIG.
  • the work W1 shown in FIG. 8 is shown by a dotted line and the locus TR is shown by a two-dot chain line.
  • the work W1 has a thickness H1 in the z - axis direction of the robot coordinate system C1, while the work W2 has a thickness H2 ( ⁇ H1) thinner than the thickness H1. is doing.
  • the tip 32a of the scraper 16 passes through the position P1 and hits the surface Q2 of the work W2 at the position P1'located at the lower right of the position P1. I will come in contact with you. Then, the processor 40 starts the operation of moving the hand portion 28b of the robot 12 upward before reaching the teaching point TP 3 , and the scraper 16 is located below the position P2. At position P2', it will be separated from the surface Q2.
  • the time-varying characteristics of the pressing force F when scraping is performed in this way are shown as solid lines in FIG. 22.
  • the time change characteristic of the pressing force F (corresponding to FIG. 13) when scraping is performed on the work W1 shown in FIG. 8 is shown by overlapping with a broken line.
  • the peak value FP'of the pressing force F is smaller than the peak value FP when the work W1 is scraped.
  • the scraper 16 may not be sufficiently pressed against the surface Q2 of the work W2, and the depth E of the formed recess R may not reach the desired size.
  • the processor 40 changes the speed command FC V_1 (speed VF_1 ) generated at the time of force control according to the thickness H of the work W.
  • the speed command FC V_1 can be changed by changing the gain G for generating the speed command FC V_1 , the maximum rotation speed VMAX of the servomotor 34, or the time constant T.
  • the speed command FC V_1 is generated by applying a gain G to the detection data (or the pressing force F) of the force sensor 14, and the gain G is the response speed when the servomotor 34 is operated by force control. It is a parameter that defines the gain. Further, the time constant T defines the time required for accelerating / decelerating the speed V of the servomotor 34 between zero and the maximum rotation speed VMAX .
  • the speed command FC V_1 can be increased as the gain G and the maximum rotation speed VMAX are increased or the time constant T is decreased, whereby the gradient of the time change characteristic of the pressing force F shown in FIG. 22 can be increased. (Differential value) can be increased. By increasing the gradient of the time change characteristic of the pressing force F, the pressing force F can reach the peak value FP (or the target value FT ) in a shorter time during the force control.
  • the memory 42 of the control device 18 stores in advance a data table DT1 showing the relationship between the thickness H of the work W, the gain G, the maximum rotation speed VMAX , and the time constant T.
  • a gain G, a maximum rotation speed VMAX , and a time constant T that can secure a peak value FP having a sufficient magnitude at the time of executing force control are stored in association with the thickness H.
  • the data table DT1 can be created by accumulating a data set of gain G, maximum rotation speed VMAX , and time constant T and thickness H, for example, by experimental method or simulation.
  • the operator measures the thickness H of the work W before the processor 40 executes the flow shown in FIG. Then, after the processor 40 starts the flow shown in FIG. 14, the operator sets the above-mentioned distance x 1 , distance z 1 , sharp angle ⁇ 2, speed VF_0 (speed command FC V_0 ), and speed VP_2 (speed command FC V_0) as the processing conditions MC. In addition to the speed command PC V_2 ) and the target value FT , the measured work W thickness H is input.
  • the processor 40 accepts the input of the thickness H and determines YES in step S1.
  • the processor 40 searches the data table DT1 for the gain G, the maximum rotation speed VMAX , and the time constant T corresponding to the input thickness H, and the thickness H and the gain G,
  • the maximum rotation speed VMAX and the time constant T are set as the machining condition MC. That is, in the present embodiment, the machining condition MC is set to the distance x 1 , the distance z 1 , the sharp angle ⁇ 2, the speed VF_0 (speed command FC V_0 ), the speed VP_2 (speed command PC V_2 ), and the target value FT . In addition, it further has a thickness H, a gain G, a maximum rotation speed VMAX , and a time constant T.
  • step S5 the processor 40 responds to the thickness H of the work W by using the gain G, the maximum rotation speed VMAX , and the time constant T set in step S2.
  • the speed command FC V_1 is generated, and force control is executed by this.
  • FIG. 23 shows the time change characteristic of the pressing force F when the operation flow according to the present embodiment is executed on the work W2.
  • the gradient of the change of the pressing force F is compared with the characteristic of FIG. 22.
  • the pressing force F reaches the peak value FP in a short time. Therefore, since the scraper 16 can be pressed against the surface Q2 of the work W2 with a sufficient pressing force F, the depth E of the recess R can be set to a desired value.
  • gain G, maximum rotation speed VMAX , and time constant T are exemplified as parameters for changing the speed command FC V_1 .
  • the present invention is not limited to this, and any parameter that can change the speed command FC V_1 may be used.
  • the processor 40 gives a torque command to the servomotor 34 according to the thickness H of the work W in order to quickly bring the pressing force F to the peak value FP during force control. May be changed.
  • the processor 40 does not change the speed command FC V_1 in order to secure a peak value FP having a sufficient magnitude during force control, but instead of changing the speed command FC V_1 , the teaching points TP 3 and TP 3 according to the thickness H of the work W. You may change the position of.
  • this function will be described with reference to FIG. 24.
  • the memory 42 of the control device 18 previously provides a data table DT 2 showing the relationship between the thickness H of the work W, the shift amount ⁇ 3 of the teaching point TP 3 , and the shift amount ⁇ 4 of the teaching point TP 4 .
  • the shift amounts ⁇ 3 and ⁇ 4 may be the same or different from each other.
  • shift amounts ⁇ 3 and ⁇ 4 that can secure a peak value FP having a sufficient magnitude at the time of executing force control are stored in association with the thickness H.
  • the data table DT2 can be created, for example, by accumulating a data set of the shift amounts ⁇ 3 and ⁇ 4 and the thickness H by an experimental method or a simulation.
  • the operator measures the thickness H of the work W in advance, and in step S1 in FIG. 14, the thickness H of the work W is set as the machining condition MC. Enter.
  • the processor 40 searches the data table DT2 for the shift amounts ⁇ 3 and ⁇ 4 corresponding to the input thickness H.
  • the processor 40 shifts the predetermined teaching point TP 3 to the right by the shift amount ⁇ 3 and the position data (specifically, the robot coordinate system C1) of the new teaching point TP 3 '(FIG. 24). (Coordinates) and the position data of the new teaching point TP 4'that is shifted to the right by the shift amount ⁇ 4 from the predetermined teaching point TP 4 .
  • FIG. 24 shows the orbit TR of the scraper 16 when the operation flow according to the present embodiment is executed for the work W2 with a solid line.
  • the scraper 16 is an orbit. It moves along the TR ", abuts on the surface Q1 of the work W1 at the position P1', moves to the right along the surface Q1, and then separates from the surface Q1 at the position P2".
  • the time change characteristic of the pressing force F at the time is shown.
  • FIG. 25 for comparison, the time change characteristic of the pressing force F when scraping the work W1 is performed (corresponding to FIG. 13). Shown by a broken line.
  • the pressing force F moves the scraper 16 from the position P1 to the position P1'in FIG. 24 as compared with the case where scraping is performed on the work W1. Although it started to increase with a delay of ⁇ t, the peak value FP was reached. Therefore, since the scraper 16 can be pressed against the surface Q2 of the work W2 with a sufficient pressing force F, the depth E of the recess R can be set to a desired value.
  • the processor 40 may acquire the thickness H when the work W is subjected to the first scraping. Specifically, when the processor 40 determines YES in step S14, the z-axis coordinates of the robot coordinate system C1 of the tip 32a (TCP) of the scraper 16 are based on the feedback from the rotation detector of the servomotor 34. Get z 2 .
  • the z - axis coordinate z3 of the robot coordinate system C1 on the mounting surface (not shown) on which the work W is mounted is known and is stored in advance in the memory 42.
  • the processor 40 may automatically determine the target value FT for force control according to the target depth E of the recess R. This function will be described below.
  • the depth E of the recess R formed by scraping and the target value FT of force control executed during scraping are highly correlated. Specifically, the higher the target value FT is set, the higher the peak value FP of the pressing force F during scraping, and the deeper the depth E of the formed recess R.
  • the memory 42 of the control device 18 stores in advance the data table DT3 in which the depth E and the target value FT (or the peak value FP ) are stored in association with each other.
  • This data table DT3 can be created, for example, by accumulating a data set of a depth E and a target value FT by an experimental method or a simulation.
  • the processor 40 After the processor 40 starts the flow shown in FIG. 14, the operator inputs the target depth E as the machining condition MC. Then, the processor 40 accepts the input of the target depth E and determines YES in step S1. Next, in step S2, the processor 40 searches the data table DT3 for the target value FT corresponding to the input target depth E, and sets it as the machining condition MC.
  • the processor 40 executes force control at the set target value FT to form a recess R having a target depth E.
  • the processor 40 automatically determines the target value FT that can realize the target depth E according to the target depth E input by the operator, and executes the force control. ing. According to this configuration, the depth E of the recess R formed by scraping can be controlled to a desired value.
  • the processor 40 may automatically determine the incident angle ⁇ 2 according to the target depth E of the recess R. This function will be described below.
  • the depth E of the recess R formed by scraping and the incident angle ⁇ 2 are highly correlated.
  • the memory 42 of the control device 18 stores in advance the data table DT4 in which the depth E and the incident angle ⁇ 2 are stored in association with each other.
  • This data table DT4 can be created, for example, by accumulating a data set of depth E and incident angle ⁇ 2 by an experimental method or a simulation.
  • the processor 40 After the processor 40 starts the flow shown in FIG. 14, for example, the operator sets the target depth E and the speed commands FC V_0 and PC V_2 (or distance x 1 ) in the above equation (2) as the machining condition MC. And z 1 ). Then, the processor 40 accepts the input of the machining condition MC and determines YES in step S1.
  • step S2 the processor 40 searches the data table DT4 for the incident angle ⁇ 2 corresponding to the input target depth E, and sets it as the machining condition MC. Further, the processor 40 automatically sets the other of the speed commands FC V_0 and the PC V_2 (or the distances x 1 and z 1 ) from the above equation (1).
  • the processor 40 automatically determines the incident angle ⁇ 2 that can realize the target depth E according to the target depth E input by the operator, and automatically determines the machining condition MC. It is set. According to this configuration, the depth E of the recess R formed by scraping can be controlled to a desired value.
  • the data table DT4 may store the above-mentioned angle ⁇ 1 in association with the target depth E instead of the incident angle ⁇ 2. This angle ⁇ 1 also highly correlates with the depth E of the recess R.
  • the processor 40 searches the data table DT4 for the angle ⁇ 1 corresponding to the input target depth E, and sets it as the machining condition MC.
  • the processor 40 executes the force control together with the position control, so that the pressing force F is set to a predetermined size during scraping (FIGS. 13, 20, 23, 25).
  • the case of controlling to is described.
  • the present invention is not limited to this, and the processor 40 can also control the pressing force F to a predetermined magnitude and perform scraping by executing only the position control. This function will be described with reference to FIG.
  • teaching points TP 11 , TP 12 , TP 13 , TP 14 , TP 15 , TP 16 and TP 17 are set along the surface Q1 of the work W1.
  • the teaching points TP 12 and the teaching point TP 16 are arranged at the same positions in the z-axis direction as the surface Q1 in the robot coordinate system C1
  • the teaching points TP 13 , TP 14 and TP 15 are the surfaces in the robot coordinate system C1. It is located below Q1.
  • the teaching point TP 14 is arranged at the lowermost side of the robot coordinate system C1.
  • the processor 40 executes position control to move the scraper 16 in the order of teaching points TP 11 ⁇ TP 12 ⁇ TP 13 ⁇ TP 14 ⁇ TP 15 ⁇ TP 16 ⁇ TP 17 . Specifically, the processor 40 moves the scraper 16 from the teaching point TP 11 toward the teaching point TP 12 by the robot 12.
  • the scraper 16 moves in the direction along the surface Q1 of the work W (to the right) and in the direction toward the surface Q1 (downward), and moves to the surface Q1 of the work W in an orbit inclined at the incident angle ⁇ 2.
  • the incident angle ⁇ 2 is defined by the movement path MP from the teaching point TP 11 to the teaching point TP 12 .
  • the processor 40 further moves the hand portion 28b of the robot 12 to the lower right toward the positions corresponding to the teaching points TP 13 and TP 14 , and then toward the positions corresponding to the teaching points TP 15 and TP 16 . And move it to the upper right. During this time, the processor 40 moves the tip 32a of the scraper 16 to the right while pressing it against the surface Q1 of the work W with the pressing force F.
  • the processor 40 moves the scraper 16 from the teaching point TP 16 toward the teaching point TP 17 , whereby the scraper 16 has an orbit inclined so as to form an acute angle ⁇ 3 with respect to the surface Q1. Separate from. In this way, a recess R having a length from the teaching point TP 12 to TP 16 is formed on the surface Q1.
  • the pressing force F when scraping is being executed can be controlled so as to have the time change characteristic shown in FIG.
  • the memory 42 stores in advance a data table DT5 in which the position data of the teaching point TP n (coordinates of the robot coordinate system C1) and the magnitude (or time change characteristic) of the pressing force F are stored in association with each other. ..
  • this data table DT5 it is possible to set the position data of the teaching point TP n that can control the pressing force F at the time of scraping to a desired size.
  • the processor 40 controls the pressing force F in scraping so as to have a size (time change characteristic) stored in advance in the data table DT5. can.
  • the processor 40 may repeatedly perform scraping over a plurality of times in order to form a plurality of recesses R arranged along the surface Q of the work W.
  • a group of teaching points TP n shown in FIGS. 6, 17 or 26 are set for each of the plurality of recesses R to be formed.
  • the memory 42 may store in advance the data table DT6 of the above-mentioned distance x 1 or z 1 and the depth E of the recess R. Then, in step S2 described above, the processor 40 may search the distance x 1 or z 1 corresponding to the input target depth E from the data table DT 6 and set it as the machining condition MC. The distance x 1 or z 1 also correlates with the depth E of the recess R formed.
  • the teaching point TP 2 is set so that the tip 32a of the scraper 16 is separated upward from the surface Q1 has been described.
  • the teaching point TP 2 may be arranged at the same position (or below) as the surface Q1 in the robot coordinate system C1.
  • the incident angle ⁇ 2 described above is defined by the movement path MP from the teaching point TP 1 to the teaching point TP 2 .
  • the force sensor 14 may be inserted between the work cell and the robot base 20, for example, or may be provided at any part of the robot 12. Further, the force sensor 14 is not limited to the robot 12, and may be provided on the side of the work W. For example, the pressing force F can be detected by inserting the force sensor 14 between the work W and the mounting surface on which the work W is placed. Further, the force sensor 14 is not limited to the 6-axis force sensor, and may be, for example, a 1-axis or 3-axis force sensor, or any sensor capable of detecting the pressing force F.
  • the origin of the tool coordinate system C2 is arranged at the tip 32a of the scraper 16 has been described.
  • the origin of the tool coordinate system C2 may be arranged at the center of the hand portion 28b (wrist flange), or may be arranged at any position if the position with respect to the hand portion 28b is known. May be good.
  • the origin of the sensor coordinate system C3 is not limited to the center of the force sensor 14, and may be arranged at any position known to the force sensor 14, and each axis may be defined in any direction. ..
  • the origin of the robot coordinate system C1 is not limited to the center of the robot base 20, and may be arranged at any position known to the robot 12, and each axis may be defined in any direction.
  • Robot system 10 Robot system 12 Robot 14 Force sensor 16 Scraper 18 Control device 40 Processor

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Forests & Forestry (AREA)
  • Human Computer Interaction (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

ロボットによって高品質のキサゲ加工を実行する技術が求められている。 ロボットシステム10は、ワークの表面を削るスクレーパ16を移動させるロボット12と、ロボット12を制御する制御装置18とを備える。制御装置18は、ロボット12によってスクレーパ16を、ワークの表面に沿う方向へ移動させるとともに該表面へ向かう方向へ移動させることによって、該スクレーパ16を該表面に対して鋭角を形成するように傾斜した軌道で当接させ、スクレーパ16が表面に当接している間、ロボット12がスクレーパ16を表面に押し付ける押付力が予め定めた大きさとなるように該ロボット12の位置を制御するとともに、該ロボット12によって該スクレーパ16を表面に沿う方向へ移動させることで、キサゲ加工を実行する。

Description

キサゲ加工を行うロボットシステム、方法、及びコンピュータプログラム
 本発明は、キサゲ加工を行うロボットシステム、方法、及びコンピュータプログラムに関する。
 キサゲ加工を行うロボットが知られている(例えば、特許文献1)。
特開2004-042164号公報
 ロボットによって高品質のキサゲ加工を実行する技術が求められている。
 本開示の一態様において、ワークの表面を平坦にするために削るキサゲ加工を行うロボットシステムは、表面を削るスクレーパを移動させるロボットと、ロボットを制御する制御装置とを備え、該制御装置は、ロボットによってスクレーパを、表面に沿う方向へ移動させるとともに該表面へ向かう方向へ移動させることによって、該スクレーパを該表面に対して鋭角を形成するように傾斜した軌道で当接させ、スクレーパが表面に当接している間、ロボットがスクレーパを表面に押し付ける押付力が予め定めた大きさとなるように該ロボットの位置を制御するとともに、該ロボットによって該スクレーパを沿う方向へ移動させることで、キサゲ加工を実行する。
 本開示の他の態様において、ワークの表面を削るスクレーパを移動させるロボットを用いて、該表面を平坦にするために削るキサゲ加工を行う方法は、ロボットによってスクレーパを、表面に沿う方向へ移動させるとともに該表面へ向かう方向へ移動させることによって、該スクレーパを該表面に対して鋭角を形成するように傾斜した軌道で当接させ、スクレーパが表面に当接している間、ロボットがスクレーパを表面に押し付ける押付力が予め定めた大きさとなるように該ロボットの位置を制御するとともに、該ロボットによって該スクレーパを沿う方向へ移動させることで、キサゲ加工を実行する。
 本開示によれば、ロボットによって、熟練者と同等の品質でキサゲ加工を実行することができる。
一実施形態に係るロボットシステムの概略図である。 図1に示すロボットシステムのブロック図である。 図1に示すスクレーパを、図1中の矢印Bから見た拡大図である。 図3に示すスクレーパを、図3中の矢印Dから見た拡大図である。 図1に示すスクレーパをワークの表面に押し付けた状態を示す。 ワークの表面に対して設定された教示点の一例を示す。 位置制御指令としての速度指令と、力制御指令としての速度指令を説明するための図である。 キサゲ加工中にスクレーパが実際に移動する軌道を示す。 キサゲ加工中のスクレーパの柄部の状態を模式的に示す。 キサゲ加工により形成された凹部を模式的に示す。 キサゲ加工により形成された凹部を模式的に示す。 熟練者がキサゲ加工を実行しているときにスクレーパをワークの表面に押し付ける押付力の時間変化特性を示す。 図1に示すロボットシステムがキサゲ加工を実行したときにロボットがスクレーパをワークの表面に押し付ける押付力の時間変化特性を示す。 図1に示すロボットシステムの動作フローの一例を示す。 図14中のステップS5のフローの一例を示す。 図1に示すロボットシステムがキサゲ加工を実行したときにロボットがスクレーパをワークの表面に押し付ける押付力の時間変化特性の他の例を示す。 ワークの表面に対して設定された教示点の他の例を示す。 図14中のステップS5のフローの他の例を示す。 キサゲ加工中にスクレーパが実際に移動する軌道を示す。 図1に示すロボットシステムがキサゲ加工を実行したときにロボットがスクレーパをワークの表面に押し付ける押付力の時間変化特性のさらに他の例を示す。 厚みが比較的薄いワークに対してキサゲ加工を実行したときにスクレーパが実際に移動する軌道を示す。 図21に示すワークに対してキサゲ加工を実行したときにロボットがスクレーパをワークの表面に押し付ける押付力の時間変化特性を示す。 図21に示すワークに対してキサゲ加工を実行したときにロボットがスクレーパをワークの表面に押し付ける押付力の時間変化特性を示す。 厚みが比較的薄いワークに対してキサゲ加工を実行したときにスクレーパが実際に移動する軌道を示す。 図24に示すワークに対してキサゲ加工を実行したときにロボットがスクレーパをワークの表面に押し付ける押付力の時間変化特性を示す。 ワークの表面に対して設定された教示点のさらに他の例を示す。
 以下、本開示の実施の形態を図面に基づいて詳細に説明する。なお、以下に説明する種々の実施形態において、同様の要素には同じ符号を付し、重複する説明を省略する。また、以下の説明においては、図中のロボット座標系C1のx軸プラス方向を右方、y軸プラス方向を前方、z軸プラス方向を上方として言及することがある。
 まず、図1を参照して、一実施形態に係るロボットシステム10について説明する。ロボットシステム10は、ワークの表面を平坦にするために削るキサゲ加工を行うシステムである。キサゲ加工とは、ワークの表面に形成された微小凹凸の、該ワークの厚さ方向の寸法を予め定めた範囲内(例えば、μmオーダー)にするために、該表面を削る加工である。
 この微小凹凸は、潤滑油を溜めるためのいわゆる「油溜り」として機能する。ここで、キサゲ加工は、ワークの表面をフライス盤等で加工したときに形成される微小凹凸を第1の寸法(例えば、10μm)以下とするための粗加工と、該粗加工の後に該微小凹凸を、第1の寸法よりも小さい第2の寸法(例えば、5μm)以下にする仕上げ加工とを含む。
 ロボットシステム10は、ロボット12、力センサ14、スクレーパ16、及び制御装置18を備える。本実施形態においては、ロボット12は、垂直多関節ロボットであって、ロボットベース20、旋回胴22、下腕部24、上腕部26、及び手首部28を有する。ロボットベース20は、作業セルの床の上に固定されている。旋回胴22は、鉛直軸周りに旋回可能となるように、ロボットベース20に設けられている。
 下腕部24は、旋回胴22に水平軸周りに回動可能に設けられ、上腕部26は、下腕部24の先端部に回動可能に設けられている。手首部28は、上腕部26の先端部に回動可能に設けられた手首ベース28aと、手首軸A1周りに回動可能となるように該手首ベース28aに設けられた手首フランジ28bとを有する。本実施形態においては、手首フランジ28bは、ロボット12の手先部を構成する。
 ロボット12の各構成要素(ロボットベース20、旋回胴22、下腕部24、上腕部26、手首部28)には、サーボモータ34(図2)が設けられている。これらサーボモータ34は、制御装置18からの指令に応じて、ロボット12の各可動要素(旋回胴22、下腕部24、上腕部26、手首部28、手先部28b)を駆動軸周りに回動させる。その結果、ロボット12は、スクレーパ16を移動させて任意の位置及び姿勢に配置することができる。
 力センサ14は、ロボット12がスクレーパ16をワークの表面に押し付ける押付力Fを検出する。例えば、力センサ14は、円筒状の本体部と、該本体部に設けられた複数の歪ゲージとを有する6軸力覚センサであって、手先部28bとスクレーパ16との間に介挿されている。本実施形態においては、力センサ14は、その中心軸が手首軸A1と一致するように配置されている。
 スクレーパ16は、力センサ14の先端部に固定され、キサゲ加工のためにワークの表面を削る。具体的には、スクレーパ16は、可撓性の柄部30と、該柄部30の先端部に固定された刃部32とを有する。柄部30は、その基端部が力センサ14の先端部に固定され、該力センサ14を介して、ロボット12の手先部28bに連結されている。柄部30は、力センサ14の先端部から軸線A2に沿って直線状に延びている。刃部32は、その基端32bから先端32aまで軸線A2に沿って延在している。なお、軸線A2は、手首軸A1と略直交してもよい。
 図3に示すように、刃部32の先端32aは、上側(図1中の矢印Bの方向)から見た場合に、その幅方向両端から中央に向かうにつれて外方へ膨出するように湾曲している。また、図4に示すように、刃部32の先端32aは、前側(図3中の矢印Dの方向)から見た場合に、略矩形の外形を有している。スクレーパ16は、その刃部32の先端32aを、ワークの表面に押し当てて、該先端32aで該表面を削る。
 制御装置18は、ロボット12の動作を制御する。具体的には、制御装置18は、プロセッサ40、メモリ42、I/Oインターフェース44、入力装置46、及び表示装置48を有するコンピュータである。プロセッサ40は、メモリ42、I/Oインターフェース44、入力装置46、及び表示装置48と、バス50を介して通信可能に接続されており、これらコンポーネントと通信しつつ、キサゲ加工を実行するための演算処理を行う。
 メモリ42は、RAM又はROM等を有し、各種データを一時的又は恒久的に記憶する。I/Oインターフェース44は、例えば、イーサネット(登録商標)ポート、USBポート、光ファイバコネクタ、又はHDMI(登録商標)端子を有し、プロセッサ40からの指令の下、外部機器との間でデータを有線又は無線で通信する。本実施形態においては、ロボット12の各サーボモータ34及び力センサ14は、I/Oインターフェース44に通信可能に接続されている。
 入力装置46は、キーボード、マウス、又はタッチパネル等を有し、オペレータからデータ入力を受け付ける。表示装置48は、液晶ディスプレイ又は有機ELディスプレイ等を有し、プロセッサ40からの指令の下、各種データを視認可能に表示する。なお、入力装置46又は表示装置48は、制御装置18の筐体に一体に組み込まれてもよいし、又は、制御装置18の筐体とは別体として該筐体に外付けされてもよい。
 図1に示すように、ロボット12には、ロボット座標系C1が設定されている。ロボット座標系C1は、ロボット12の各可動要素の動作を制御するための座標系であって、ロボットベース20に対して固定されている。本実施形態においては、ロボット座標系C1は、その原点が、ロボットベース20の中心に配置され、そのz軸が、旋回胴22の旋回軸に一致するように、ロボット12に対して設定されている。
 一方、スクレーパ16には、ツール座標系C2が設定されている。ツール座標系C2は、ロボット座標系C1におけるスクレーパ16(又は、手先部28b)の位置及び姿勢を規定する座標系である。本実施形態においては、ツール座標系C2は、その原点(いわゆる、TCP)が、柄部30が撓んでいない状態における刃部32の先端32aの中心に配置され、そのz軸が、軸線A2(又は、先端32aの中心における、該先端32aの曲面の法線方向)と平行となるように、スクレーパ16に対して設定されている。
 スクレーパ16を移動させるとき、制御装置18のプロセッサ40は、ロボット座標系C1においてツール座標系C2を設定し、設定したツール座標系C2によって表される位置及び姿勢にスクレーパ16を配置させるように、ロボット12の各サーボモータ34への指令を生成する。こうして、プロセッサ40は、ロボット座標系C1における任意の位置及び姿勢にスクレーパ16を位置決めできる。
 一方、力センサ14には、センサ座標系C3が設定されている。センサ座標系C3は、力センサ14に作用する力の方向を定義する座標系である。本実施形態においては、センサ座標系C3は、その原点が力センサ14の中心に配置され、そのz軸が手首軸A1に一致する(又は、そのx軸がツール座標系C2のz軸と平行となる)ように、力センサ14に対して設定されている。
 図5に、ロボット12がスクレーパ16の刃部32の先端32aをワークW1の表面Q1に当接させた状態を示す。ロボット12がスクレーパ16の先端32aを表面Q1に対し、該表面Q1と直交する方向へ押付力Fで押し付けた場合、該押付力Fの反力F’が、該表面Q1からスクレーパ16を介して力センサ14に加えられる。
 力センサ14の歪ゲージの各々は、このときに力センサ14に作用する力に応じた検出データを制御装置18に送信する。プロセッサ40は、I/Oインターフェース44を通して力センサ14から受信した検出データに基づいて、このときに力センサ14に作用する、センサ座標系C3のx軸、y軸及びz軸の方向の力fと、x軸周り、y軸周り及びz軸周りの方向のトルクτとを求める。プロセッサ40は、力f及びトルクτと、このときのスクレーパ16の状態データCDとに基づいて、刃部32の先端32aに対し、表面Q1と直交する方向に作用する反力F’の大きさを演算する。
 状態データCDは、例えば、軸線A2と表面Q1との角度θ1、手首軸A1(又は、センサ座標系C3の原点)から刃部32の先端32aまでの距離d、ロボット座標系C1におけるツール座標系C2(又はセンサ座標系C3)の位置及び姿勢を示すデータ、並びに、柄部30の撓みデータ(例えば、柄部30の撓み量又は弾性率)の少なくとも1つを含む。このように、力センサ14は、反力F’を押付力Fとして検出し、制御装置18は、力センサ14の検出データに基づいて押付力F(反力F’)の大きさを求めることができる。
 次に、図6~図8を参照して、ロボットシステム10が実行するキサゲ加工について説明する。図6に示すように、キサゲ加工を実行するためにスクレーパ16の先端32a(つまり、TCP)を位置決めすべき複数の教示点TP、TP、TP、及びTPが、ワークW1の表面Q1に沿って予め設定される。
 本実施形態においては、教示点TPは、教示点TPよりも右下方に離隔した位置に設定され、教示点TPは、教示点TPの右方に離隔した位置に設定されている。教示点TP及びTPのロボット座標系C1のz軸方向の位置は、互いに略同じである。また、教示点TPは、教示点TPよりも右上方に離隔した位置に設定されている。これら教示点TP(n=1,2,3,4)は、ロボット座標系C1の座標として表され、ロボット12を動作させるためのコンピュータプログラムCPに規定されている。
 キサゲ加工を行うとき、プロセッサ40は、位置制御を開始する。具体的には、プロセッサ40は、位置制御の開始後、ロボット12によってスクレーパ16を複数の教示点TPへ順に移動させるための位置制御指令PCを生成する。具体的には、プロセッサ40は、スクレーパ16の先端32aを教示点TPから教示点TPn+1へ移動させるための位置制御指令PCを生成する。
 プロセッサ40は、この位置制御指令PCに従ってロボット12の各サーボモータ34を動作させることによって、スクレーパ16を、教示点TP→TP→TP→TPの順に位置決めする。この位置制御により、プロセッサ40は、スクレーパ16(具体的には、先端32a)を、複数の教示点TPによって規定される移動経路MPに沿って移動させる。
 なお、本実施形態においては、理解の容易のために、ワークW1の表面Q1は、ロボット座標系C1のx-y平面と略平行であり、移動経路MPの方向MDは、ロボット座標系C1のx-z平面と略平行であるとする。位置制御指令PCは、スクレーパ16(つまり、ロボット12の手先部28b)を、教示点TPから教示点TPn+1まで移動させるときの速度VP_nを規定する速度指令PCV_n(第1速度指令)を有する。
 位置制御の開始後、スクレーパ16が図6中の教示点TPに到達したとき、プロセッサ40は、力制御を開始する。なお、本実施形態においては、教示点TPは、スクレーパ16の先端32aが該教示点TPに配置されたときに該先端32aが表面Q1から上方へ離隔するように、設定されている。力制御の開始後、プロセッサ40は、力センサ14の検出データに基づいて、ロボット12がスクレーパ16をワークW1の表面Q1に押し付ける押付力Fを目標値Fに制御するように、ロボット12の手先部28b(又は、TCP)の位置を制御する。
 具体的には、プロセッサ40は、力制御において、力センサ14の検出データに基づいて取得した押付力F(具体的には、反力F’)を目標値Fに制御すべく、ロボット12の手先部28b(TCP)の位置を制御するための力制御指令FCを生成する。そして、プロセッサ40は、該力制御指令FCを位置制御指令PCに加えて、ロボット12のサーボモータ34を動作させる。
 これにより、プロセッサ40は、位置制御指令PCに従ってスクレーパ16(又は、手先部28b)を方向MDに移動させるとともに、力制御指令FCに従ってスクレーパ16をワークW1の表面Q1に対して接近又は離反する方向(すなわち、ロボット座標系C1のz軸方向)へ移動させる。力制御指令FCは、スクレーパ16をロボット座標系C1のz軸方向へ移動させる速度を規定する速度指令FC(第2速度指令)を有する。
 スクレーパ16が教示点TPに到達したとき、プロセッサ40は、スクレーパ16を教示点TPから教示点TPへ移動させるための位置制御指令PCとして速度指令PCV_2を生成するともに、力制御指令FCとして速度指令FCV_0を生成する。図7に、スクレーパ16が教示点TPに到達したときにプロセッサ40が生成する速度指令PCV_2及び速度指令FCV_0を模式的に示す。
 スクレーパ16が教示点TPに到達した後、プロセッサ40は、速度指令PCV_2に従ってロボット12を動作させて、スクレーパ16を教示点TPから教示点TPへ、速度指令PCV_2に対応する(具体的には、一致する)速度VP_2で、方向MDへ移動させる。
 これとともに、プロセッサ40は、速度指令FCV_0を生成し、サーボモータ34への速度指令PCV_2に加えることで、スクレーパ16を表面Q1へ向かう方向(すなわち、下方)へ、該速度指令FCV_0に対応する速度VF_0で移動させる。その結果、ロボット12は、スクレーパ16を、教示点TPを通過した後、図7中の方向MD’へ移動させることになる。
 図8に、キサゲ加工においてスクレーパ16(具体的には、先端32a)が実際に辿る軌道TRを実線で示す。スクレーパ16は、教示点TPを通過した後、表面Q1に対して鋭角θ2を形成するように傾斜した軌道TRで表面Q1へ向かって移動し、位置P1で該表面Q1に当接する。スクレーパ16が表面Q1に当接している間、プロセッサ40は、位置制御指令PCに従ってスクレーパ16を、表面Q1に沿う方向MD(すなわち、右方)へ移動させるとともに、力制御によって押付力Fを目標値Fに制御するための力制御指令FCとして速度指令FCV_1を生成する。
 この速度指令FCV_1により、ロボット12の手先部28bの位置を、ロボット座標系C1のz軸方向に、速度指令FCV_1に対応する速度VF_1で、変位させる。ここで、スクレーパ16が表面Q1に当接している間に生成する速度指令FCV_1(すなわち、速度VF_1)の最大値は、スクレーパ16が表面Q1に当接する前に生成する速度指令FCV_0(すなわち、速度VF_0)よりも、大きく設定され得る。
 こうして、スクレーパ16が、目標値Fに対応する大きさの押付力Fで押し付けられながら表面Q1に沿って右方へ移動され、これにより、スクレーパ16の先端32aで表面Q1を削るキサゲ加工が実行される。キサゲ加工中のスクレーパ16の状態を図9に示す。図9に示すように、キサゲ加工中、ロボット12は、スクレーパ16の先端32aを押付力Fで表面Q1に押し付け、これにより、スクレーパ16の柄部30は、下方へ膨出するように湾曲して撓む。換言すれば、力制御の目標値Fは、キサゲ加工中に柄部30を撓ませることができる値として、設定される。
 再度、図8を参照して、スクレーパ16(又は手先部28b)が教示点TPに対応する位置に到達すると、プロセッサ40は、スクレーパ16を教示点TPへ移動させるための位置制御指令PCを生成する。プロセッサ40は、位置制御指令PCに従ってロボット12を動作させることで、手先部28bを右上方へ移動させる。その結果、スクレーパ16は、ワークW1の表面Q1に対して鋭角θ3を形成するように傾斜した軌道TRで右上方へ移動し、該スクレーパ16の先端32aが、位置P2で表面Q1から離反する。こうして、キサゲ加工が終了する。
 このように実行されたキサゲ加工によって、図10及び図11に示すように、表面Q1に、湾曲状に凹む凹部Rが、位置P1から位置P2まで右方へ延在するように、形成される。図10及び図11に示す例では、凹部Rは、ロボット座標系C1のx軸方向の長さxとz軸方向の深さEとを有する。なお、図10及び図11では、理解の容易のために、凹部Rの深さEを拡大して図示しているが、実際の凹部Rの深さEは、約10μm以下であることを理解されたい。
 本実施形態においては、プロセッサ40は、上述の鋭角θ2が予め定めた範囲内となるように、速度指令PCV_2及びFCV_0を生成する。ここで、本発明者は、キサゲ加工の熟練者がスクレーパ16の刃部32をワークW1の表面Q1に対して15°~35°の角度の軌道で移動させて該表面Q1に当接させているという知見を得た。
 また、本発明者は、熟練者がキサゲ加工を連続して実行しているときにスクレーパ16の刃部32をワークW1の表面Q1に押し付ける押付力Fの時間変化特性のデータを取得した。この時間変化特性を図12に示す。図12に示す時間変化特性から、本発明者は、1回の(つまり、1個の凹部Rを形成する)キサゲ加工において熟練者が刃部32を表面Q1に対して押し付ける押付力Fの大きさ(時間変化特性のピーク値)を取得するとともに、熟練者がキサゲ加工中に刃部32を移動させている速度が約100[mm/sec]であることを突き止めた。
 ここで、図8中の教示点TPと位置P1との間の、ロボット座標系C1のx軸及びz軸方向の距離を、それぞれ、距離x及びzとすると、該距離x及びz、速度指令PCV_2(速度VP_2)、及び速度指令FCV_0(速度VF_0)は、以下の式(1)を満たす。
   z/x=FCV_0/PCV_2=VF_0/VP_2 …(1)
 また、鋭角θ2、距離x及びz、速度指令PCV_2(速度VP_2)、及び速度指令FCV_0(速度VF_0)は、以下の式(2)を満たす。
   θ2=tan-1(z/x)=tan-1(FCV_0/PCV_2)=tan-1(VF_0/VP_2) …(2)
 よって、仮に、キサゲ加工の加工条件MCとして、x=10[mm]、z=5[mm]に設定すると、式(2)より、鋭角θ2≒26.6°として決定できる。この場合において、加工条件MCとして、速度VP_2(すなわち、速度指令PCV_2)を、上述の熟練者によるスクレーパ16の移動速度と同様に100[mm/sec]に設定した場合、式(1)より、速度VF_0(すなわち、速度指令FCV_0)を、50[mm/sec]として決定できる。
 代替的には、加工条件MCとして、θ2=25°、速度指令PCV_2(速度VP_2)=100[mm/sec]に設定した場合、式(2)より、FCV_0(速度VF_0)≒46.6[mm/sec]として決定できる。この場合において、z=10[mm]に設定すると、式(1)より、x≒21.4[mm]として決定できる。
 また、加工条件MCとして、目標値Fは、ワークW1の材質と凹部Rの目標深さEに応じた値(例えば100[N])に設定される。このように、加工条件MCは、距離x、距離z、鋭角θ2、速度VF_0(速度指令FCV_0)、及び、速度VP_2(速度指令PCV_2)を含む。
 本発明者は、熟練者によるキサゲ加工を観察し、鋭意検討の結果、加工条件MCを適切に設定すれば、上述の鋭角θ2を、例えば15°~35°の範囲内となるように制御することができるとともに、図12と同様の時間変化特性となるように押付力Fを制御でき、以って、ロボット12によって熟練者と同等の品質でキサゲ加工を実行できることを見出した。
 図13に、プロセッサ40が所定の加工条件MCに従ってロボット12を動作させてキサゲ加工を連続して実行した(つまり、複数の凹部Rを形成した)ときにスクレーパ16の刃部32をワークW1の表面Q1に押し付ける押付力Fの時間変化特性を示す。図13に示すように、適切に設定した加工条件MCに従ってロボット12にキサゲ加工を実行させることで、1回のキサゲ加工における押付力Fを、図12と類似する時間変化特性の大きさとなるように、制御することができる。
 以下、図8及び図13を参照して、ロボット12によるキサゲ加工中の押付力Fの時間変化について、詳細に説明する。スクレーパ16の先端32aが位置P1でワークW1の表面Q1に当接した後、プロセッサ40は、力制御指令FC(速度指令FCV_1)を生成することで、ロボット12の手先部28bの位置を速度VF_1で下方へ変位させ、これにより、押付力Fは急激に増大する。
 一方、プロセッサ40は、上述したようにスクレーパ16を教示点TPから教示点TPへ移動させるための位置制御指令PC(速度指令PCV_2)を生成しているが、教示点TPに近づくにつれて位置制御指令PCが力制御指令FCよりも優勢となり、プロセッサ40は、スクレーパ16(手先部28b)を、教示点TPに対応する位置に到達させる前に、ワークW1の表面Q1から離れる方向(すなわち、上方)へ移動させることになる。その結果、押付力Fの大きさは、図13に示すピーク値Fとなった後に急激に減少する。
 ここで、本実施形態においては、キサゲ加工によって形成する凹部Rの長さxを比較的短くすべく、教示点TPと教示点TPとの間のロボット座標系C1のx軸方向の距離xが、比較的短く設定されている。この場合、プロセッサ40は、押付力Fが力制御の目標値Fに到達する前に、スクレーパ16を上方へ移動させることになる。したがって、本実施形態においては、ピーク値Fは、目標値Fよりも小さくなる。
 その後、プロセッサ40は、位置制御指令PC及びPCに従ってロボット12を動作させることで、スクレーパ16を、鋭角θ3を形成するように傾斜した軌道TRに沿って右上方へ移動させ、スクレーパ16が位置P2で表面Q1から離反した時点で、押付力Fがゼロになる。このようにして、プロセッサ40は、キサゲ加工における押付力Fを、図13に示す特性として予め定めた大きさとなるように、制御している。
 なお、押付力Fの「予め定めた大きさ」とは、ピーク値Fのみならず、図13に示す時間変化特性も含む。また、上述したように、本実施形態においては、押付力Fのピーク値Fは、力制御の目標値Fよりも小さくなっている。このピーク値Fは、目標値Fに対応し、該目標値Fに依存して変化する。換言すれば、ピーク値Fは、目標値Fによって制御可能である。
 次に、図14を参照して、ロボットシステム10の動作フローの一例について説明する。プロセッサ40は、メモリ42に予め格納されたコンピュータプログラムCPに従って、図14に示すフローを実行する。図14に示すフローは、例えば、制御装置18が起動されたときに、開始される。
 ステップS1において、プロセッサ40は、加工条件MCの入力を受け付けたか否かを判定する。例えば、プロセッサ40は、加工条件MCとして、上述の距離x、距離z、鋭角θ2、速度VF_0(速度指令FCV_0)、速度VP_2(速度指令PCV_2)、及び目標値Fを入力するための入力画面の画像データを生成し、制御装置18の表示装置48に表示させる。
 オペレータは、表示装置48に表示された入力画面を視認しつつ、制御装置18の入力装置46を操作して、加工条件MCとして、距離x、距離z、鋭角θ2、速度VF_0(速度指令FCV_0)、及び速度VP_2(速度指令PCV_2)のうちの少なくとも3つのデータを入力するとともに、目標値Fを入力する。プロセッサ40は、入力装置46から加工条件MCの入力データを受け付けた場合にYESと判定し、ステップS2へ進む一方、加工条件MCの入力データを受け付けていない場合はNOと判定し、ステップS3へ進む。
 ステップS2において、プロセッサ40は、加工条件MCを決定する。例えば、オペレータが、ステップS1において、加工条件MCとしてx=10[mm]、z=5[mm]、VP_2(PCV_2)=100[mm/sec]と入力したとする。この場合、プロセッサ40は、加工条件MCの入力データと、上述の式(1)及び(2)とから、加工条件MCとして、θ2=26.6°、及び、VF_0(FCV_0)=50[mm/sec]として自動で決定する。
 このように、本実施形態においては、プロセッサ40は、オペレータから入力を受け付けた加工条件MCのうちの一部のパラメータに応じて、加工条件MCのうちの他のパラメータを自動で決定する。そして、プロセッサ40は、これらx=10[mm]、z=5[mm]、VP_2(PCV_2)=100[mm/sec]、θ2=26.6°、及びVF_0(FCV_0)=50[mm/sec]、及び目標値Fを、加工条件MCとして設定する。
 ステップS3において、プロセッサ40は、オペレータ、上位コントローラ、又はコンピュータCPから、キサゲ加工開始指令を受け付けたか否かを判定する。プロセッサ40は、キサゲ加工開始指令を受け付けた場合にYESと判定し、ステップS4へ進む一方、キサゲ加工開始指令を受け付けていない場合にNOと判定し、ステップS6へ進む。
 ステップS4において、プロセッサ40は、全ての加工条件MCが設定済みであるか否かを判定する。具体的には、プロセッサ40は、加工条件MCとして距離x、距離z、鋭角θ2、速度VF_0(速度指令FCV_0)、及び速度VP_2(速度指令PCV_2)の全てが設定済みである場合はYESと判定し、ステップS5へ進む。一方、プロセッサ40は、加工条件MCとして距離x、距離z、鋭角θ2、速度VF_0(速度指令FCV_0)、及び速度VP_2(速度指令PCV_2)の少なくとも1つが未設定である場合はNOと判定し、ステップS7へ進む。
 ステップS5において、プロセッサ40は、キサゲ加工を実行する。このステップS5について、図15を参照して説明する。ステップS11において、プロセッサ40は、位置制御を開始する。具体的には、プロセッサ40は、上述の位置制御指令PCを生成する動作を開始し、ロボット12によってスクレーパ16の先端32aを、教示点TP→TP→TP→TPの順に移動させる動作を開始する。
 ステップS12において、プロセッサ40は、スクレーパ16が教示点TPに到達したか否かを判定する。例えば、ロボット12のサーボモータ34には、該サーボモータ34の回転(具体的には、回転角度又は回転位置)を検出する回転検出器(エンコーダ、又はホール素子等)が設けられる。
 プロセッサ40は、回転検出器からのフィードバックに基づいて、ロボット座標系C1におけるスクレーパ16(具体的には、TCP)の位置データを取得し、該位置データから、該スクレーパ16が教示点TPに到達したか否かを判定できる。プロセッサ40は、スクレーパ16が教示点TPに到達した(すなわち、YES)と判定した場合は、ステップS13へ進む一方、スクレーパ16が教示点TPに到達していない(すなわち、NO)と判定した場合は、ステップS12をループする。
 ステップS13において、プロセッサ40は、力制御を開始する。具体的には、プロセッサ40は、上述の力制御指令FCを生成する動作を開始し、位置制御指令PCに力制御指令FCを加えてロボット12を動作させる。ここで、上述のステップS2において、加工条件MCとして、速度指令PCV_2=100[mm/sec]、及び、速度指令FCV_0=50[mm/sec]に設定されている。
 したがって、プロセッサ40は、位置制御指令PCとして速度指令PCV_2=100[mm/sec]を生成するともに、力制御指令FCとして速度指令FCV_0=50[mm/sec]を生成する。該速度指令PCV_2及びFCV_0でロボット12を動作させることで、プロセッサ40は、スクレーパ16を、速度VP_2=100[mm/sec]で方向MDへ移動させるとともに、速度VF_0=50[mm/sec]で下方へ移動させる。その結果、スクレーパ16は、鋭角θ2≒26.6°で傾斜する軌道TR(図8)に沿ってワークW1の表面Q1へ向かって移動する。こうして、鋭角θ2を所定の範囲内(例えば15°~35°)に制御できる。
 ステップS14において、プロセッサ40は、力センサ14の検出データに基づいて取得した押付力Fが、予め定めた閾値Fth以上(F≧Fth)となったか否かを判定する。この閾値Fthは、スクレーパ16の先端32aがワークW1の表面Q1に当接したことを示す値として、オペレータによって予め定められる。プロセッサ40は、F≧Fthとなった場合にYESと判定し、ステップS15へ進む一方、F<Fthである場合はNOと判定し、ステップS14をループする。
 ステップS15において、プロセッサ40は、力制御指令FCを切り換える。具体的には、プロセッサ40は、生成する力制御指令FCを、速度指令FCV_0から速度指令FCV_1に切り換える。速度指令FCV_1への切り換え後、プロセッサ40は、該速度指令FCV_1を生成し、押付力Fを目標値Fに制御すべく、ロボット12の手先部28bの位置を、ロボット座標系C1のz軸方向に、該速度指令FCV_1に対応する速度VF_1で変位させる。上述したように、速度VF_1(速度指令FCV_1)の最大値は、速度VF_0(速度指令FCV_0)よりも大きくなり得る。
 ステップS16において、プロセッサ40は、スクレーパ16(又は、手先部28b)が教示点TPに対応する位置に到達したか否かを判定する。ここで、ステップS13の開始後は、プロセッサ40が位置制御と力制御を並行して実行するので、スクレーパ16の先端32aは、図8に示す軌道TRに沿って移動することで、教示点TP及びTPの下方を通過することになる。
 プロセッサ40は、このステップS16において、上述の回転検出器からのフィードバックに基づいて、先端32a(又は、手先部28b)のロボット座標系C1のx座標が教示点TPのx座標と一致したか否かを判定する。プロセッサ40は、YESと判定した場合は、ステップS17へ進む一方、NOと判定した場合は、ステップS16をループする。
 ステップS16でYESと判定する前に、スクレーパ16の先端32aは、上述したように、位置P2でワークW1の表面Q1から離反する。そして、ステップS17において、プロセッサ40は、力制御と位置制御を終了する。こうして、1回のキサゲ加工が終了し、図10及び図11に示すような凹部RがワークW1の表面Q1に形成される。
 再度、図14を参照して、プロセッサ40は、ステップS6において、オペレータ、上位コントローラ、又はコンピュータプログラムCPから動作終了指令を受け付けたか否かを判定する。プロセッサ40は、動作終了指令を受け付けた場合にYESと判定し、図14に示すフローを終了する一方、動作終了指令を受け付けていない場合はNOと判定し、ステップS1へ戻る。
 一方、ステップS4でNOと判定した場合、ステップS7において、プロセッサ40は、警告信号を発信する。例えば、プロセッサ40は、「加工条件を設定してください」という音声又は画像の警告信号を生成し、制御装置18に設けられたスピーカ(図示せず)又は表示装置48を通して、オペレータに出力する。そして、プロセッサ40は、ステップS1へ戻る。
 以上のように、本実施形態においては、プロセッサ40は、ロボット12によってスクレーパ16を、鋭角θ2で傾斜した軌道TRでワークW1の表面Q1に当接させている。そして、プロセッサ40は、スクレーパ16が表面Q1に当接している間、押付力Fを予め定めた大きさ(図13)に制御するとともに、スクレーパ16を表面Wに沿って右方へ移動させることで、キサゲ加工を実行している。この構成によれば、ロボット12によって、熟練者と同等の品質でキサゲ加工を実行することができる。
 また、本実施形態においては、プロセッサ40は、スクレーパ16がワークW1の表面Q1に当接している間、力センサ14の検出データに基づいて力制御を実行することによって、ロボット12の手先部28bの位置を、ロボット座標系C1のz軸方向へ制御している。この構成によれば、キサゲ加工中に、押付力Fを、図13に示す特性として予め定めた大きさとなるように、高精度に制御することが可能となる。
 これにより、ロボット12がキサゲ加工を実行しているときの押付力Fの時間変化特性を、熟練者による押付力Fの時間変化特性(図12)に近づけることができるので、ロボット12が実行するキサゲ加工の品質を、熟練者の品質に、より効果的に近づけることが可能となる。
 また、本実施形態においては、プロセッサ40は、位置制御指令PC(具体的には、速度指令PCV_2)に従ってスクレーパ16を教示点TPから教示点TPへ移動させるとともに、力制御指令FC(具体的には、速度指令FCV_0)に従ってスクレーパ16を下方へ移動させることによって、該スクレーパ16を、鋭角θ2だけ傾斜した軌道TRでワークW1の表面Q1に当接させている。
 そして、プロセッサ40は、鋭角θ2が予め定めた範囲内(例えば、15°~35°)となるように、速度指令PCV_2及びFCV_0を生成している。この構成によれば、位置制御指令PC(速度指令PCV_2)及び力制御指令FC(速度指令FCV_0)によって、軌道TRの鋭角θ2を、所望の範囲内となるように高精度に制御できる。これにより、ロボット12が実行するキサゲ加工の品質を、熟練者の品質に、さらに効果的に近づけることが可能となる。
 また、本実施形態においては、プロセッサ40は、力制御の実行中に押付力Fが目標値Fに到達する前に、スクレーパ16をワークW1の表面Q1から離れる方向(すなわち、上方)へ移動させて、キサゲ加工を終了している。この構成によれば、1回のキサゲ加工における押付力Fの時間変化特性(図13)を、熟練者による押付力Fの時間変化特性(図12)に効果的に近づけることができる。また、凹部Rを、図9に示すように、その中央部分が凹む湾曲状に形成できる。これにより、キサゲ加工の品質を向上させることができる。
 また、本実施形態においては、プロセッサ40、キサゲ加工を実行しているときに、スクレーパ16を、ワークW1の表面Q1に対して鋭角θ3を形成するように傾斜した軌道TRで該表面Q1から離反させて、キサゲ加工を終了している。この構成によれば、凹部Rを湾曲状に形成することができるので、キサゲ加工の品質を向上させることができる。
 なお、この鋭角θ3は、教示点TP及びTPの位置、又は、教示点TPから教示点TPまでの移動経路MPと、教示点TPから教示点TPまでの移動経路MPとの角度を調整することによって、制御可能である。一例として、この鋭角θ3は、14°~20°の角度となるように制御される。
 また、本実施形態においては、図9に示すように、キサゲ加工の実行中に刃部32がワークW1の表面Q1に押し付けられたときに柄部30が撓むように、力制御の目標値F(すなわち、押付力Fの大きさ)が定められている。この構成によれば、柄部30の撓みによってキサゲ加工中に生じた刃部32の微小振動が吸収されるとともに、刃部32から表面Q1へ押付力Fを均等に作用させることができる。その結果、形成する凹部Rの表面が波状となってしまうのを防止できるので、キサゲ加工の品質を向上させることができる。
 なお、プロセッサ40は、キサゲ加工中に、スクレーパ16の軸線A2が、図7中の方向MD’(つまり、教示点TPから位置P1までの軌道TR)と平行(すなわち、θ1=θ2)となるように、手首部の姿勢を制御してもよい。又は、プロセッサ40は、θ1<θ2(又は、θ1>θ2)を満たす(つまり、軸線A2と方向MD’とが非平行となる)ように、手首部の姿勢を制御してもよい。
 上述の実施形態においては、プロセッサ40が、力制御の実行中に押付力Fが目標値Fに到達する前にスクレーパ16を上方へ移動させる場合について述べた。しかしながら、これに限らず、プロセッサ40は、力制御の実行中に押付力Fが目標値Fに到達した時点でスクレーパ16を上方へ移動させてもよい。この場合、押付力Fの時間変化特性は、図13と同様となる一方、ピーク値Fは、目標値Fと同じとなる。
 一例として、教示点TPと教示点TPとの間の距離xを、上述の実施形態よりも長くすることによって、ピーク値Fが目標値Fと同じとなるように押付力Fを制御することができる。代替的には、プロセッサ40は、刃部32がワークW1の表面Q1と当接した(上述のステップS14でYESと判定)後の力制御で生成する速度指令FCV_1を増大させることによって、ピーク値Fが目標値Fと同じとなるように押付力Fを制御することもできる。
 また、プロセッサ40は、力制御によって押付力Fが目標値Fに到達した後に該押付力Fを該目標値Fに継続して維持するように、キサゲ加工を継続して実行してもよい。例えば、教示点TPと教示点TPとの間の距離xを長く設定し、プロセッサ40が図14及び図15のフローを実行した場合、押付力Fを該目標値Fに継続して維持するようにキサゲ加工を継続させることになる。
 このようなキサゲ加工における押圧力Fの時間変化特性を図16に示す。スクレーパ16が教示点TPを通過した後に位置P1でワークW1の表面Q1に当接した後、押付力Fが急激に上昇し、目標値Fに略一致する。その後、プロセッサ40は、位置制御指令PCに従ってスクレーパ16を教示点TPへ向かって右方へ移動させる間、押付力Fを該目標値Fに継続して維持させるように力制御指令FC(具体的には、速度指令FCV_1)を生成し、ロボット12の手先部28bの位置を制御する。
 次いで、プロセッサ40は、上述の実施形態と同様に、スクレーパ16を教示点TPに対応する位置(具体的には、教示点TPの下方位置)に到達させる前に、スクレーパ16を上方へ移動させる。その結果、押付力Fが急激に減少し、スクレーパ16の刃部32が位置P2でワークW1の表面Q1から離反したときに、押付力Fはゼロとなる。
 こうして、プロセッサ40は、キサゲ加工における押付力Fを、図16に示す特性として予め定めた大きさとなるように、制御している。本実施形態によれば、ロボット12によって、比較的長い長さxを有する凹部Rを、熟練者と同等の品質で形成することができる。
 なお、教示点TPは、図6に示す形態に限らず、如何なる数の教示点がワークWに対して設定されてもよい。図17に、教示点TPの他の形態を示す。図17に示す形態においては、ワークW1の表面Q1に沿って、教示点TP、TP、TP、TP、及びTPが設定されている。ここで、教示点TPは、教示点TPの右方に配置され、教示点TP、TP及びTPの、ロボット座標系C1のz軸方向の位置は、互いに略同じである。そして、教示点TPは、教示点TPの右上方に配置されている。
 次に、図14、図18、及び図19を参照して、図17に示すように教示点TPが設定された場合のロボットシステム10の動作フローについて説明する。本実施形態においても、プロセッサ40は、図14に示すフローを実行するが、本実施形態に係るフローは、上述の実施形態と、ステップS5において相違する。以下、図18を参照して、本実施形態に係るステップS5について説明する。
 ステップS5の開始後、プロセッサ40は、上述の実施形態と同様に、ステップS11~S16を実行する。これにより、スクレーパ16は、図19に示すように、教示点TPから教示点TPへ移動した後、鋭角θ2で傾斜する軌道TRでワークW1の表面Q1へ向かって移動し、位置P1で表面Q1に当接する。
 スクレーパ16が表面Q1に当接している間、プロセッサ40は、位置制御指令PC及びPCに従ってスクレーパ16を方向MD(右方)へ移動させるとともに、力制御によって押付力Fを目標値Fに制御するための速度指令FCV_1を生成する。図20に、本実施形態においてプロセッサ40が力制御を実行したときの押付力Fの時間変化特性を示す。力制御によってスクレーパ16が位置P1で表面Q1に当接した時点tから、押付力Fは、急激に増大する。
 ここで、本実施形態においては、プロセッサ40は、スクレーパ16が教示点TPに対応する位置に到達した時点tで押付力Fがピーク値Fに達し、その後、スクレーパ16(具体的には、先端32a)が教示点TPに対応する位置(具体的には、教示点TPの下方位置)に到達した時点t(すなわち、ステップS16でYESと判定した時点)で押付力Fがゼロとなるように、力制御指令FC(具体的には、速度指令FCV_1)を生成してロボット12の手先部28bの位置を制御する。また、プロセッサ40は、スクレーパ16が時点tでワークW1の表面Q1に当接した状態となるように、位置制御指令PC及び力制御指令FCを生成する。
 再度、図18を参照して、ステップS16でYESと判定したとき(時点t)、ステップS21において、プロセッサ40は、力制御を終了する。ステップS21の後、プロセッサ40は、位置制御指令PCに従ってロボット12を動作させることにより、スクレーパ16を、図19に示すように鋭角θ3で傾斜する軌道TRに沿って右上方へ移動させ、その結果、スクレーパ16は、位置P2でワークW1の表面Q1から離反してキサゲ加工が終了する。
 ステップS22において、プロセッサ40は、スクレーパ16が教示点TPに対応する位置に到達したか否かを判定する。プロセッサ40は、YESと判定した場合はステップS23へ進む一方、NOと判定した場合はステップS22をループする。そして、ステップS23において、プロセッサ40は位置制御を終了する。
 以上のように、本実施形態においては、スクレーパ16が教示点TPに到達した時点tで押付力Fがピーク値Fに達し、スクレーパ16が教示点TPに到達した時点tで押付力Fがゼロとなるように、力制御を実行している。この構成によれば、図20に示す押付力Fの時間変化特性を、より詳細に制御可能となるので、熟練者がキサゲ加工を実行しているときの押付力Fの時間変化に効果的に近づけることができる。
 なお、上述の実施形態において、プロセッサ40は、ロボット座標系C1のz軸方向におけるワークWの厚さHに応じて、力制御指令を変更してもよい。以下、この機能について説明する。図21に、図8に示すワークW1よりも薄い厚さHを有するワークW2に対してプロセッサ40が図14に示すフローを実行したときのスクレーパ16の実際の軌跡TR’を示す。なお、図21においては、比較のために、図8に示すワークW1を点線、軌跡TRを二点鎖線で、それぞれ重ねて図示している。
 また、図21に示す形態においては、教示点TP(n=1~4)は、図8の形態と同じロボット座標系C1の位置に設定されているとする。図21に示すように、ワークW1は、ロボット座標系C1のz軸方向の厚さHを有する一方、ワークW2は、厚さHよりも薄い厚さH(<H)を有している。
 このワークW2に対してプロセッサ40がキサゲ加工を実行した場合、スクレーパ16の先端32aは、位置P1を通過して、該位置P1の右下方に位置する位置P1’でワークW2の表面Q2と当接することになる。そして、プロセッサ40は、上述の実施形態と同様に、教示点TPに到達する前にロボット12の手先部28bを上方へ移動させる動作を開始し、スクレーパ16は、位置P2の下方に位置する位置P2’で表面Q2から離反することになる。
 このようにキサゲ加工を実行した場合の押付力Fの時間変化特性を図22に実線として示す。なお、図22においては、比較のために、図8に示すワークW1に対してキサゲ加工を実行したときの押付力Fの時間変化特性(図13に対応)を破線で重ねて示している。図22に示すように、厚さが薄いワークW2をキサゲ加工した場合、押付力Fのピーク値F’が、ワークW1をキサゲ加工したときのピーク値Fよりも小さくなってしまう。この場合、ワークW2の表面Q2へのスクレーパ16の押付けが不十分となり、形成される凹部Rの深さEが、所望の大きさに満たない可能性がある。
 そこで、本実施形態においては、プロセッサ40は、ワークWの厚さHに応じて、力制御時に生成する速度指令FCV_1(速度VF_1)を変更する。速度指令FCV_1は、速度指令FCV_1を生成するためのゲインG、サーボモータ34の最大回転数VMAX又は時定数Tを変更することで、変更可能である。
 ここで、速度指令FCV_1は、力センサ14の検出データ(又は、押付力F)にゲインGをかけることで生成され、該ゲインGは、力制御によってサーボモータ34を動作させるときの応答速さを規定するパラメータとなる。また、時定数Tは、サーボモータ34の速度Vを、ゼロと最大回転数VMAXとの間で加減速させるのに要する時間を規定する。
 ゲインG及び最大回転数VMAXを大きくする程、又は、時定数Tを小さくする程、速度指令FCV_1を増大させることができ、これにより、図22に示す押付力Fの時間変化特性の勾配(微分値)を大きくすることができる。押付力Fの時間変化特性の勾配を大きくすることで、力制御中に押付力Fを、より短時間でピーク値F(又は目標値F)に到達させることができる。
 一例として、制御装置18のメモリ42は、ワークWの厚さHと、ゲインG、最大回転数VMAX、及び時定数Tとの関係性を示すデータテーブルDT1を予め格納する。このデータテーブルDT1においては、力制御実行時に十分な大きさのピーク値Fを確保できるゲインG、最大回転数VMAX、及び時定数Tが、厚さHに関連付けられて格納されている。データテーブルDT1は、例えば、実験的手法又はシミュレーションによって、ゲインG、最大回転数VMAX、及び時定数Tと、厚さHとのデータセットを蓄積することで、作成され得る。
 一方、オペレータは、プロセッサ40が図14に示すフローを実行する前に、ワークWの厚さHを測定する。そして、プロセッサ40が図14に示すフローを開始した後、オペレータは、加工条件MCとして、上述の距離x、距離z、鋭角θ2、速度VF_0(速度指令FCV_0)、速度VP_2(速度指令PCV_2)、及び目標値Fに加えて、測定したワークWの厚さHを入力する。
 そうすると、プロセッサ40は、厚さHの入力を受け付けて、ステップS1でYESと判定する。次いで、ステップS2において、プロセッサ40は、入力された厚さHに対応するゲインG、最大回転数VMAX、及び時定数TをデータテーブルDT1から検索し、該厚さHと、該ゲインG、該最大回転数VMAX、及び該時定数Tとを、加工条件MCとして設定する。すなわち、本実施形態においては、加工条件MCは、距離x、距離z、鋭角θ2、速度VF_0(速度指令FCV_0)、速度VP_2(速度指令PCV_2)、及び目標値Fに加えて、厚さH、ゲインG、最大回転数VMAX、及び時定数Tをさらに有する。
 そして、ステップS5中のステップS14でYESと判定した後、プロセッサ40は、ステップS2で設定したゲインG、最大回転数VMAX、及び時定数Tを用いることで、ワークWの厚さHに応じた速度指令FCV_1を生成し、これにより力制御を実行する。図23に、本実施形態に係る動作フローをワークW2に対して実行した場合の押付力Fの時間変化特性を示す。
 図23に示すように、本実施形態によれば、ワークW2の厚さHに応じて速度指令FCV_1を増大させることにより、押付力Fの変化の勾配が、図22の特性と比べて大きくなり、その結果、押圧力Fが、短時間でピーク値Fへ到達している。したがって、ワークW2の表面Q2へスクレーパ16を十分な押付力Fで押し付けることができるので、凹部Rの深さEを所望の値とすることができる。
 なお、本実施形態においては、速度指令FCV_1を変更するためのパラメータとして、ゲインG、最大回転数VMAX、及び時定数Tを例示した。しかしながら、これに限らず、速度指令FCV_1を変更可能な如何なるパラメータを用いてもよい。また、速度指令FCV_1に限らず、プロセッサ40は、力制御時に押付力Fをピーク値Fへ迅速に到達させるために、ワークWの厚さHに応じて、サーボモータ34へのトルク指令を変更してもよい。
 なお、プロセッサ40は、力制御時に十分な大きさのピーク値Fを確保するために、速度指令FCV_1を変更する代わりに、ワークWの厚さHに応じて教示点TP及びTPの位置を変更してもよい。以下、図24を参照して、この機能について説明する。一例として、制御装置18のメモリ42は、ワークWの厚さHと、教示点TPのずらし量δ、及び教示点TPのずらし量δとの関係性を示すデータテーブルDT2を予め格納する。なお、ずらし量δ及びδは、互いに同じであってもよいし、又は、異なってもよい。
 このデータテーブルDT2においては、力制御実行時に十分な大きさのピーク値Fを確保できるずらし量δ及びδが、厚さHに関連付けられて格納されている。データテーブルDT2は、例えば、実験的手法、又はシミュレーションによって、ずらし量δ及びδと厚さHとのデータセットを蓄積することで、作成され得る。
 一方、図21及び図23を参照して上述した形態と同様に、オペレータは、ワークWの厚さHを予め測定し、図14中のステップS1において、加工条件MCとしてワークWの厚さHを入力する。ステップS2において、プロセッサ40は、入力された厚さHに対応するずらし量δ及びδをデータテーブルDT2から検索する。
 そして、プロセッサ40は、予め定められた教示点TPを、ずらし量δだけ右方へずらした新たな教示点TP’(図24)の位置データ(具体的には、ロボット座標系C1の座標)と、予め定められた教示点TPを、ずらし量δだけ右方へずらした新たな教示点TP’の位置データとを取得する。
 その後、プロセッサ40は、ステップS3~S7を順次実行することで、キサゲ加工を実行する。図24に、本実施形態に係る動作フローをワークW2に対して実行した場合のスクレーパ16の軌道TR”を実線で示す。図24に示すように、本実施形態においては、スクレーパ16は、軌道TR”に沿って移動して、位置P1’でワークW1の表面Q1と当接し、該表面Q1に沿って右方へ移動した後、位置P2”で表面Q1から離反する。図25に、このときの押付力Fの時間変化特性を示す。なお、図25においては、比較のために、ワークW1に対してキサゲ加工を実行したときの押付力Fの時間変化特性(図13に対応)を破線で示す。
 図25に示すように、本実施形態によれば、押付力Fは、ワークW1に対してキサゲ加工を実行したときと比べて、スクレーパ16が図24中の位置P1から位置P1’まで移動するのに要した時間Δtだけ遅れて増加し始めているが、ピーク値Fに到達している。したがって、ワークW2の表面Q2へスクレーパ16を十分な押付力Fで押し付けることができるので、凹部Rの深さEを所望の値とすることができる。
 なお、上述の実施形態においては、オペレータが、ワークWの厚さHを測定する場合について述べた。しかしながら、これに限らず、プロセッサ40は、ワークWに対して1回目のキサゲ加工を実行したときに、厚さHを取得してもよい。具体的には、プロセッサ40は、ステップS14でYESと判定したときに、サーボモータ34の回転検出器からのフィードバックに基づいて、スクレーパ16の先端32a(TCP)のロボット座標系C1のz軸座標zを取得する。
 一方、ワークWが載置された載置面(図示せず)の、ロボット座標系C1のz軸座標zは、既知であって、メモリ42に予め記憶される。プロセッサ40は、ワークWの厚さHを、H=z-zなる式から求めることができる。そして、プロセッサ40は、ワークWに対して2回目のキサゲ加工する場合に、図23又は図25を参照して説明した方法により、押付力Fをピーク値Fに到達させるように力制御を実行してもよい。
 なお、上述の実施形態において、プロセッサ40は、凹部Rの目標深さEに応じて、力制御の目標値Fを自動で決定してもよい。以下、この機能について説明する。ここで、キサゲ加工によって形成される凹部Rの深さEと、キサゲ加工中に実行する力制御の目標値Fとは、高度に相関する。具体的には、目標値Fを高く設定する程、キサゲ加工中の押付力Fのピーク値Fが高くなり、これにより、形成される凹部Rの深さEが深くなる。
 一例として、制御装置18のメモリ42は、深さEと目標値F(又はピーク値F)とが互いに関連付けられて格納されたデータテーブルDT3を予め格納する。このデータテーブルDT3は、例えば、実験的手法、又はシミュレーションによって、深さEと目標値Fとのデータセットを蓄積することで、作成され得る。
 プロセッサ40が図14に示すフローを開始した後、オペレータは、加工条件MCとして、目標深さEを入力する。そうすると、プロセッサ40は、目標深さEの入力を受け付けて、ステップS1でYESと判定する。次いで、ステップS2において、プロセッサ40は、入力された目標深さEに対応する目標値FをデータテーブルDT3から検索し、加工条件MCとして設定する。
 そして、プロセッサ40は、ステップS13の開始後、設定した目標値Fで力制御を実行することで、目標深さEを有する凹部Rが形成される。このように、本実施形態においては、プロセッサ40は、オペレータが入力した目標深さEに応じて、該目標深さEを実現可能な目標値Fを自動で決定し、力制御を実行している。この構成によれば、キサゲ加工によって形成する凹部Rの深さEを、所望の値に制御することができる。
 なお、上述の実施形態において、プロセッサ40は、凹部Rの目標深さEに応じて、入射角θ2を自動で決定してもよい。以下、この機能について説明する。ここで、キサゲ加工によって形成される凹部Rの深さEと入射角θ2とは、高度に相関する。例えば、入射角θ2を小さく設定する程、形成される凹部Rの深さEが浅くなり得る。
 一例として、制御装置18のメモリ42は、深さEと入射角θ2とが互いに関連付けられて格納されたデータテーブルDT4を予め格納する。このデータテーブルDT4は、例えば、実験的手法、又はシミュレーションによって、深さEと入射角θ2とのデータセットを蓄積することで、作成され得る。
 プロセッサ40が図14に示すフローを開始した後、例えば、オペレータは、加工条件MCとして、目標深さEと、上述の式(2)中の速度指令FCV_0及びPCV_2(又は、距離x及びz)のうちの一方とを入力する。そうすると、プロセッサ40は、加工条件MCの入力を受け付けてステップS1でYESと判定する。
 次いで、ステップS2において、プロセッサ40は、入力された目標深さEに対応する入射角θ2をデータテーブルDT4から検索し、加工条件MCとして設定する。また、プロセッサ40は、上述の式(1)より、速度指令FCV_0及びPCV_2(又は、距離x及びz)のうちの他方を自動で設定する。
 このように、本実施形態においては、プロセッサ40は、オペレータが入力した目標深さEに応じて、該目標深さEを実現可能な入射角θ2を自動で決定し、加工条件MCとして自動で設定している。この構成によれば、キサゲ加工によって形成する凹部Rの深さEを、所望の値に制御することができる。
 なお、データテーブルDT4は、入射角θ2の代わりに、上述の角度θ1を目標深さEに関連付けて格納してもよい。この角度θ1も、凹部Rの深さEと高度に相関する。この場合、プロセッサ40は、ステップS2において、入力された目標深さEに対応する角度θ1をデータテーブルDT4から検索し、加工条件MCとして設定する。
 なお、上述の実施形態においては、プロセッサ40が、位置制御とともに力制御を実行することによって、キサゲ加工中に押付力Fを予め定めた大きさ(図13、図20、図23、図25)に制御する場合について述べた。しかしながら、これに限らず、プロセッサ40は、位置制御のみを実行することによって、押付力Fを予め定めた大きさに制御し、キサゲ加工を実行することもできる。この機能について、図26を参照して説明する。
 図26に示す形態においては、ワークW1の表面Q1に沿って、教示点TP11、TP12、TP13、TP14、TP15、TP16、及びTP17が設定されている。ここで、教示点TP12及び教示点TP16は、ロボット座標系C1における表面Q1と同じz軸方向の位置に配置され、教示点TP13、TP14及びTP15は、ロボット座標系C1における表面Q1の下方の位置に配置されている。また、これら教示点TP(n=11~17)の中で、教示点TP14が、ロボット座標系C1の最も下側に配置されている。
 この形態の場合、プロセッサ40は、位置制御を実行して、スクレーパ16を、教示点TP11→TP12→TP13→TP14→TP15→TP16→TP17の順で移動させる。具体的には、プロセッサ40は、ロボット12によってスクレーパ16を教示点TP11から教示点TP12へ向かって移動させる。
 これにより、スクレーパ16は、ワークWの表面Q1に沿う方向(右方)へ移動するとともに該表面Q1へ向かう方向(下方)へ移動し、入射角θ2で傾斜する軌道でワークWの表面Q1に教示点TP12にて当接する。本実施形態においては、入射角θ2は、教示点TP11から教示点TP12までの移動経路MPによって規定される。
 その後、プロセッサ40は、ロボット12の手先部28bを、教示点TP13及びTP14に対応する位置へ向かって右下方へさらに移動させ、次いで、教示点TP15及びTP16に対応する位置へ向かって右上方へ移動させる。この間、プロセッサ40は、スクレーパ16の先端32aを押付力FでワークWの表面Q1に押し付けつつ、右方へ移動させる。
 そして、プロセッサ40は、スクレーパ16を教示点TP16から教示点TP17へ向かって移動させ、これにより、スクレーパ16は、表面Q1に対して鋭角θ3を形成するように傾斜した軌道で該表面Q1から離反する。こうして、教示点TP12からTP16までの長さを有する凹部Rが表面Q1に形成される。
 ここで、教示点TPの位置を適切に選択することによって、キサゲ加工を実行しているときの押付力Fを、図13に示す時間変化特性となるように、制御することができる。一例として、メモリ42は、教示点TPの位置データ(ロボット座標系C1の座標)と、押付力Fの大きさ(又は時間変化特性)とを互いに関連付けて格納したデータテーブルDT5を予め格納する。
 このデータテーブルDT5により、キサゲ加工実行時の押付力Fを所望の大きさに制御可能な教示点TPの位置データを設定することができる。このように設定した教示点TPに従って位置制御を実行することにより、プロセッサ40は、キサゲ加工における押付力Fを、データテーブルDT5に予め格納した大きさ(時間変化特性)となるように、制御できる。
 なお、上述の実施形態においては、ワークWの表面Qに対して、1回のキサゲ加工を実行する場合について述べた。しかしながら、プロセッサ40は、ワークWの表面Qに並ぶ複数の凹部Rを形成するために、キサゲ加工を複数回に亘って繰り返し実行してもよい。この場合、形成する複数の凹部Rの各々に対して、図6、図17又は図26に示す一群の教示点TPがそれぞれ設定される。
 例えば、複数の凹部Rの各々に対して図6に示す一群の教示点TP(n=1~4)が設定された場合、プロセッサ40は、図14に示すフローにおいて、第1の凹部Rを形成するために設定された第1群の教示点TPに関して、1回目のステップS5を実行し、次いで、第2の凹部Rを形成するために設定された第2群の教示点TPに関して、2回目のステップS5を実行する。このようにして、プロセッサ40は、第mの凹部Rを形成するために設定された第m群の教示点TPに関して、m回目のステップS5を実行する(m=1,2,3,・・・)ことでキサゲ加工を繰り返し実行し、複数の凹部Rを形成できる。
 なお、メモリ42は、上述の距離x又はzと凹部Rの深さEとのデータテーブルDT6を予め格納してもよい。そして、プロセッサ40は、上述のステップS2において、入力された目標深さEに対応する距離x又はzをデータテーブルDT6から検索し、加工条件MCとして設定してもよい。距離x又はzも、形成される凹部Rの深さEと相関する。
 上述の実施形態においては、教示点TPが、スクレーパ16の先端32aが表面Q1から上方へ離隔するように設定される場合について述べた。しかしながら、これに限らず、教示点TPは、ロボット座標系C1における表面Q1と同じ位置(又は下方)に配置されてもよい。この場合、上述の入射角θ2は、教示点TPから教示点TPまでの移動経路MPによって規定される。
 力センサ14は、例えば、作業セルとロボットベース20との間に介挿されてもよいし、又は、ロボット12の如何なる部位に設けられてもよい。また、力センサ14は、ロボット12に限らず、ワークWの側に設けられてもよい。例えば、力センサ14を、ワークWと、該ワークWが載置される載置面との間に介挿することによって、押付力Fを検出できる。また、力センサ14は、6軸力覚センサに限らず、例えば、1軸又は3軸力センサであってもよいし、押付力Fを検出可能な如何なるセンサであってもよい。
 また、上述の実施形態においては、ツール座標系C2の原点がスクレーパ16の先端32aに配置される場合について述べた。しかしながら、これに限らず、ツール座標系C2の原点は、例えば、手先部28b(手首フランジ)の中心に配置されてもよいし、手先部28bに対する位置が既知であれば如何なる位置に配置されてもよい。
 また、センサ座標系C3の原点は、力センサ14の中心に限らず、力センサ14に対して既知である如何なる位置に配置されてもよいし、その各軸は如何なる方向に定義されてもよい。また、ロボット座標系C1の原点は、ロボットベース20の中心に限らず、ロボット12に対して既知である如何なる位置に配置されてもよいし、その各軸は如何なる方向に定義されてもよい。以上、実施形態を通じて本開示を説明したが、上述の実施形態は、特許請求の範囲に係る発明を限定するものではない。
 10  ロボットシステム
 12  ロボット
 14  力センサ
 16  スクレーパ
 18  制御装置
 40  プロセッサ

Claims (10)

  1.  ワークの表面を平坦にするために削るキサゲ加工を行うロボットシステムであって、
     前記表面を削るスクレーパを移動させるロボットと、
     前記ロボットを制御する制御装置と、を備え、
     前記制御装置は、
      前記ロボットによって前記スクレーパを、前記表面に沿う方向へ移動させるとともに該表面へ向かう方向へ移動させることによって、該スクレーパを該表面に対して鋭角を形成するように傾斜した軌道で当接させ、
      前記スクレーパが前記表面に当接している間、前記ロボットが前記スクレーパを前記表面に押し付ける押付力が予め定めた大きさとなるように該ロボットの位置を制御するとともに、該ロボットによって該スクレーパを前記沿う方向へ移動させることで、前記キサゲ加工を実行する、ロボットシステム。
  2.  前記押付力を検出する力センサをさらに備え、
     前記制御装置は、前記スクレーパが前記表面に当接している間、前記力センサの検出データに基づいて、前記押付力を、前記予め定めた大きさに対応する目標値に制御する力制御を実行することによって、前記ロボットの前記位置を制御する、請求項1に記載のロボットシステム。
  3.  前記制御装置は、
      前記表面に沿って予め定められた複数の教示点へ前記スクレーパを順に移動させるための位置制御指令を生成し、
      前記スクレーパを、前記表面から離隔する第1の前記教示点に移動させたときに、前記力制御を開始して該スクレーパを前記向かう方向へ移動させるための力制御指令を生成し、
      前記位置制御指令に従って前記スクレーパを前記第1の教示点から第2の前記教示点へ移動させるとともに、前記力制御指令に従って前記スクレーパを前記向かう方向へ移動させることによって、該スクレーパを前記傾斜した軌道で前記表面に当接させる、請求項2に記載のロボットシステム。
  4.  前記位置制御指令は、前記スクレーパを前記第1の教示点から前記第2の教示点まで移動させるときの速度を規定する第1速度指令を有し、
     前記力制御指令は、前記スクレーパを前記向かう方向へ移動させる速度を規定する第2速度指令を有し、
     前記制御装置は、前記鋭角が予め定めた範囲内となるように、前記第1速度指令及び前記第2速度指令を生成する、請求項3に記載のロボットシステム。
  5.  前記制御装置は、前記力制御の実行中に前記押付力が前記目標値に到達した時点又は到達する前に、前記スクレーパを前記表面から離れる方向へ移動させて前記キサゲ加工を終了する、請求項2~4のいずれか1項に記載のロボットシステム。
  6.  前記制御装置は、前記力制御によって前記押付力が前記目標値に到達した後に該押付力を該目標値に継続して維持するように、前記キサゲ加工を継続して実行する、請求項2~4のいずれか1項に記載のロボットシステム。
  7.  前記制御装置は、前記キサゲ加工を実行しているときに、前記ロボットによって前記スクレーパを、前記表面に対して鋭角を形成するように傾斜した軌道で該表面から離反させて、前記キサゲ加工を終了する、請求項1~6のいずれか1項に記載のロボットシステム。
  8.  前記スクレーパは、
      前記ロボットの手先部に連結された可撓性の柄部と、
      前記柄部の先端に固定され、前記表面を削る刃部と、を有し、
     前記キサゲ加工の実行中に前記刃部が前記表面に押し付けられたときに前記柄部が撓むように、前記押付力の前記大きさが定められる、請求項1~7のいずれか1項に記載のロボットシステム。
  9.  ワークの表面を削るスクレーパを移動させるロボットを用いて、該表面を平坦にするために削るキサゲ加工を行う方法であって、
     前記ロボットによって前記スクレーパを、前記表面に沿う方向へ移動させるとともに該表面へ向かう方向へ移動させることによって、該スクレーパを該表面に対して鋭角を形成するように傾斜した軌道で当接させ、
     前記スクレーパが前記表面に当接している間、前記ロボットが前記スクレーパを前記表面に押し付ける押付力が予め定めた大きさとなるように該ロボットの位置を制御するとともに、該ロボットによって該スクレーパを前記沿う方向へ移動させることで、前記キサゲ加工を実行する、方法。
  10.  請求項9に記載の方法をプロセッサに実行させるコンピュータプログラム。
PCT/JP2021/032167 2020-09-08 2021-09-01 キサゲ加工を行うロボットシステム、方法、及びコンピュータプログラム WO2022054674A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN202180054527.0A CN116056840A (zh) 2020-09-08 2021-09-01 进行刮研加工的机器人系统、方法以及计算机程序
DE112021004741.8T DE112021004741T5 (de) 2020-09-08 2021-09-01 Robotersystem, verfahren und computerprogramm zum durchführen eines schabprozesses
JP2022547531A JP7469487B2 (ja) 2020-09-08 2021-09-01 キサゲ加工を行うロボットシステム、方法、及びコンピュータプログラム
US18/023,522 US20230311317A1 (en) 2020-09-08 2021-09-01 Robot system, method, and computer program for performing scraping process

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020150703 2020-09-08
JP2020-150703 2020-09-08

Publications (1)

Publication Number Publication Date
WO2022054674A1 true WO2022054674A1 (ja) 2022-03-17

Family

ID=80632304

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/032167 WO2022054674A1 (ja) 2020-09-08 2021-09-01 キサゲ加工を行うロボットシステム、方法、及びコンピュータプログラム

Country Status (5)

Country Link
US (1) US20230311317A1 (ja)
JP (1) JP7469487B2 (ja)
CN (1) CN116056840A (ja)
DE (1) DE112021004741T5 (ja)
WO (1) WO2022054674A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023190242A1 (ja) * 2022-03-31 2023-10-05 シチズン時計株式会社 自動キサゲ加工装置及び自動キサゲ加工方法
WO2024116979A1 (ja) * 2022-11-30 2024-06-06 シチズン時計株式会社 キサゲ加工装置及びキサゲ加工方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05123921A (ja) * 1991-02-20 1993-05-21 Nippon Spindle Mfg Co Ltd キサゲ加工方法及びその装置
JP2010240809A (ja) * 2009-04-10 2010-10-28 Star Micronics Co Ltd 自動キサゲ装置
JP2016137551A (ja) * 2015-01-28 2016-08-04 ファナック株式会社 ロボットを用いたキサゲ加工装置及びキサゲ加工方法
JP6723623B1 (ja) * 2019-08-05 2020-07-15 登茂二 翁 切削加工方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3702342B2 (ja) 2002-07-10 2005-10-05 国立大学法人岐阜大学 柔軟な構造を特徴とする切削工具ホルダ及びその使用方法
JP5123921B2 (ja) 2009-11-30 2013-01-23 昭和電線ケーブルシステム株式会社 絶縁ブッシングと電力ケーブルとの接続部およびこれを用いたケーブル接続部

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05123921A (ja) * 1991-02-20 1993-05-21 Nippon Spindle Mfg Co Ltd キサゲ加工方法及びその装置
JP2010240809A (ja) * 2009-04-10 2010-10-28 Star Micronics Co Ltd 自動キサゲ装置
JP2016137551A (ja) * 2015-01-28 2016-08-04 ファナック株式会社 ロボットを用いたキサゲ加工装置及びキサゲ加工方法
JP6723623B1 (ja) * 2019-08-05 2020-07-15 登茂二 翁 切削加工方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023190242A1 (ja) * 2022-03-31 2023-10-05 シチズン時計株式会社 自動キサゲ加工装置及び自動キサゲ加工方法
WO2024116979A1 (ja) * 2022-11-30 2024-06-06 シチズン時計株式会社 キサゲ加工装置及びキサゲ加工方法

Also Published As

Publication number Publication date
CN116056840A (zh) 2023-05-02
JPWO2022054674A1 (ja) 2022-03-17
US20230311317A1 (en) 2023-10-05
DE112021004741T5 (de) 2023-07-13
JP7469487B2 (ja) 2024-04-16

Similar Documents

Publication Publication Date Title
WO2022054674A1 (ja) キサゲ加工を行うロボットシステム、方法、及びコンピュータプログラム
US10766140B2 (en) Teach mode collision avoidance system and method for industrial robotic manipulators
CN107662098A (zh) 控制装置、机器人及机器人系统
JP6619395B2 (ja) ロボットシステムおよびロボットの教示方法
JP6582483B2 (ja) ロボット制御装置およびロボットシステム
TWI599459B (zh) 機器人
US10960549B2 (en) Vibration analyzer and vibration analysis method
US10987742B2 (en) Method of controlling positioning control apparatus and positioning control apparatus
JP7464629B2 (ja) 研磨量推定装置
JP2019126894A (ja) ロボット制御装置及びロボットシステム
JP2021030364A (ja) ロボット制御装置
JP2018069361A (ja) 力制御座標軸設定装置、ロボットおよび力制御座標軸設定方法
EP2907599B1 (en) Peening device and peening method
CN110842909B (zh) 控制装置、机器人系统以及机器人
Ochoa et al. Impedance control architecture for robotic-assisted micro-drilling tasks
WO2021149563A1 (ja) ロボットシミュレーション装置
WO2022158427A1 (ja) キサゲ加工によって形成すべき凹部の位置を決定する装置、ロボットシステム、及び方法
WO2022145299A1 (ja) キサゲ加工を行うロボットシステム、方法、及びコンピュータプログラム
WO2022163467A1 (ja) キサゲ加工を行うロボット、ロボットシステム、方法、及びコンピュータプログラム
JP5961077B2 (ja) ロボット制御装置およびロボット制御方法
JP4598720B2 (ja) 数値制御工作機械の制御装置
KR102591945B1 (ko) 로봇 강성 유지 자세를 구현하는 가공 장치 및 이를 이용한 로봇 강성 유지 자세를 구현하는 가공 방법
WO2024127622A1 (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: 21866633

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2022547531

Country of ref document: JP

Kind code of ref document: A

122 Ep: pct application non-entry in european phase

Ref document number: 21866633

Country of ref document: EP

Kind code of ref document: A1