WO2023190030A1 - 産業機器の制御装置 - Google Patents

産業機器の制御装置 Download PDF

Info

Publication number
WO2023190030A1
WO2023190030A1 PCT/JP2023/011499 JP2023011499W WO2023190030A1 WO 2023190030 A1 WO2023190030 A1 WO 2023190030A1 JP 2023011499 W JP2023011499 W JP 2023011499W WO 2023190030 A1 WO2023190030 A1 WO 2023190030A1
Authority
WO
WIPO (PCT)
Prior art keywords
link
control
industrial equipment
control device
proximal
Prior art date
Application number
PCT/JP2023/011499
Other languages
English (en)
French (fr)
Inventor
祐紀 志村
昌紀 利見
幸太 古橋
Original Assignee
Ntn株式会社
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 Ntn株式会社 filed Critical Ntn株式会社
Publication of WO2023190030A1 publication Critical patent/WO2023190030A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23QDETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
    • B23Q15/00Automatic control or regulation of feed movement, cutting velocity or position of tool or work
    • B23Q15/007Automatic control or regulation of feed movement, cutting velocity or position of tool or work while the tool acts upon the workpiece
    • B23Q15/12Adaptive control, i.e. adjusting itself to have a performance which is optimum according to a preassigned criterion
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • 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/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/416Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control of velocity, acceleration or deceleration

Definitions

  • the present invention relates to a control device for industrial equipment that requires high speed, high precision, and a wide operating range, such as medical equipment or industrial equipment such as visual inspection equipment.
  • Patent Document 1 discloses a work device that has a base plate and a traveling plate, connects them with a plurality of links, and performs a predetermined work using a parallel link mechanism that moves the traveling plate by cooperatively operating these links.
  • Patent Document 2 proposes a link actuation device that is compact, yet capable of high speed, high precision, and operation over a wide range of motion.
  • An object of the present invention is to provide a control device for industrial equipment that can accommodate a wide range of loading weights and has increased versatility.
  • the industrial equipment control device of the present invention is an industrial equipment control device Cu that controls the actuator 10 in the industrial equipment in which the tip member 40 is movably provided by the actuator 10, Parameter switching means 65b is provided for switching control parameters so as to adjust the jerk of the actuator 10 or the tip member 40 in accordance with the load acting on the tip member 40.
  • the "jerk” is the rate of change in acceleration per unit time, and is also called “jerk” or "jerch.”
  • the industrial equipment is a link actuating device 7, in which a link hub 13 on the distal side is connected to a link hub 12 on the proximal side via three or more sets of link mechanisms 14 so that the posture can be changed.
  • Each of the link mechanisms 14 includes proximal and distal end link members 15 and 16, one end of which is rotatably connected to the proximal link hub 12 and the distal link hub 13, respectively. , a central link member 17 whose both ends are rotatably connected to the other ends of these end link members 15 and 16 on the proximal end side and the distal end side, and two of the three or more sets of link mechanisms 14.
  • the link mechanisms 14 of more than one set may be provided with the actuator 10 for attitude control that arbitrarily changes the attitude of the link hub 13 on the distal end side with respect to the link hub 12 on the proximal end side.
  • the link actuating device 7 adopts a parallel link mechanism, and there is no need to arrange a servo motor in the movable part, and since the movable part is lightweight, the jerk can be increased to perform fine movements at high speed. I am good at doing this.
  • the jerk greatly affects the speed, that is, the takt time, and as the mounted weight increases, the movable parts become heavier and vibrations are more likely to occur. Therefore, the control parameters are set to adjust the jerk.
  • the parameter switching means 65b for switching becomes more effective.
  • the parameter switching means 65b may switch a plurality of control parameters including at least one of the filter time constant and model following control gain of the moving average filter.
  • the jerk can be decreased, so that the shock generated by the change in acceleration is decreased. Therefore, when the onboard weight (load) is large, these control parameters are changed by the parameter switching means 65b so as to increase the filter time constant of the moving average filter or to decrease the model following control gain. Thereby, the vibration during settling and the torque of the actuator 10 can be reduced without reducing the speed of the industrial equipment, and the vibration of the tip member 40 during settling and during operation can be reduced.
  • the parameter switching means 65b may switch a plurality of control parameters for adjusting the acceleration of the actuator 10 or the tip member 40.
  • the adjustment range of control parameters is expanded, and vibrations and vibrations during settling and operation can be reduced without reducing the speed of the industrial equipment. torque can be reduced.
  • the plurality of control parameters for adjusting the acceleration may include at least one of acceleration time, deceleration time, and command speed. If the control parameters related to acceleration include at least one of acceleration time, deceleration time, and command speed, acceleration can be easily adjusted.
  • the parameter switching means 65b may decrease the jerk and increase the acceleration as the load increases. Since the impact on the tip member 40 of industrial equipment is influenced more by jerk than by acceleration, by adjusting the control parameters in this way, it becomes possible to operate the industrial equipment at higher speed.
  • the industrial equipment includes an operating device O that sets at least the operation pattern of the tip member 40 and the control parameters, and the operating device Ou may include an operating means 61 that selects and changes load conditions.
  • the operating means 61 of the operating device Ou not only sets the operation pattern and control parameters of the control device Cu, but also easily switches the control parameters to values corresponding to the load conditions. You will be able to do this.
  • FIG. 1 is a block diagram of a control device for a link actuating device according to a first embodiment of the present invention, and a perspective view of the link actuating device to be controlled by the control device. It is a front view of the operating device of the same control device. It is a perspective view of the same link actuation device.
  • FIG. 1 is a block diagram of a control device for a link actuating device according to a first embodiment of the present invention, and a perspective view of the link actuating device to be controlled by the control device. It is a front view of the operating device of the same control device. It is a perspective view of the same link actuation device.
  • FIG. 1 is a block diagram of a control device for a link actuating device according to a first embodiment of the present invention, and a perspective view of the link actuating device to be controlled by the control device. It is a front view of the operating device of the same control device. It is a perspective view of the same link actuation device.
  • FIG. 2 is a front view of a simplified model of the same link actuating device in which two link mechanisms are omitted.
  • FIG. 5B is an enlarged view of a portion surrounded by a dashed line in FIG. 5B.
  • 5 is a partial cross-sectional view taken along the line VA-VA in FIG. 4.
  • FIG. It is a figure which expresses one link mechanism of the same link actuating device by a straight line. It is a figure which shows the maximum bending angle etc. of the same link actuation device. It is a figure which shows the relationship between the load condition of the same link actuation device, and a control parameter.
  • FIG. 4 is a diagram showing, for reference, speed waveforms and the like when no filter time constant is set.
  • FIG. 3 is a block diagram of a control system when a filter time constant is not set. It is a block diagram of a control system when a filter time constant is set in the same control device. It is a front view of the link actuation device etc. which concern on the 2nd Embodiment of this invention. It is a perspective view of the link actuation device etc. which concern on the 3rd Embodiment of this invention. It is a front view of industrial equipment etc. concerning the 4th embodiment of the present invention. It is a front view of industrial equipment etc. concerning the 5th embodiment of the present invention.
  • FIG. 1 A control device for industrial equipment according to an embodiment of the present invention will be described with reference to FIGS. 1 to 10B.
  • the link actuating device 7 will be explained first as an industrial device to be controlled, and then the control device Cu of this link actuating device 7 and the operating device Ou shown in FIG. 2 will be explained.
  • the following description also includes a description of a method for controlling industrial equipment.
  • the link actuating device 7 includes a parallel link mechanism 9, an attitude control actuator (actuator) 10 for actuating the parallel link mechanism 9, and an operating device Ou (FIG. 2) to be described later.
  • a Parallel link mechanism 9 In the parallel link mechanism 9, a link hub 12 on the proximal side and a link hub 13 on the distal side are connected via three sets of link mechanisms 14 so that the posture can be changed.
  • the number of link mechanisms 14 may be four or more. In FIG. 4, only one set of link mechanisms 14 is shown, and the remaining two link mechanisms are omitted.
  • Each link mechanism 14 has an end link member 15 on the proximal side, an end link member 16 on the distal side, and a central link member 17, and forms a four-bar chain link mechanism consisting of four rotating pairs.
  • the proximal and distal end link members 15 and 16 are L-shaped, and one end is rotatably connected to the proximal link hub 12 and the distal link hub 13, respectively.
  • the central link member 17 has the other ends of the proximal and distal end link members 15 and 16 rotatably connected to both ends thereof.
  • the parallel link mechanism 9 has a structure that combines two spherical link mechanisms.
  • the central axis of each rotating pair of the proximal link hub 12 and the proximal end link member 15, and each rotating pair of the proximal end link member 15 and the central link member 17 is They intersect at the center of the spherical link PA.
  • the central axes of each rotating pair of the distal link hub 13 and the distal end link member 16, and each rotating pair of the distal end link member 16 and the central link member 17 are formed on the distal spherical surface. They intersect at the link center PB.
  • the distance between the center of the rotating pair of the proximal link hub 12 and the proximal end link member 15 and the proximal spherical link center PA is the same.
  • the distance between the center of the rotation pair of the proximal end link member 15 and the central link member 17 and the proximal spherical link center PA is the same.
  • the distance between the center of the rotation pair of the distal link hub 13 and the distal end link member 16 and the distal spherical link center PB is the same.
  • the distance between the center of the rotation pair of the end link member 16 on the distal side and the center link member 17 and the spherical link center PB on the distal side is the same.
  • the central axes of each rotating pair of the proximal and distal end link members 15, 16 and the central link member 17 may have a certain intersection angle ⁇ , or may be parallel.
  • FIG. 5B shows the relationship between the central axis O1 of each rotating pair of the proximal link hub 12 and the proximal end link member 15 and the spherical link center PA.
  • the shape and positional relationship of the link hub 13 (FIG. 4) on the distal side and the end link member 16 (FIG. 4) on the distal side are also similar to those in FIG. 5B.
  • the central axis O1 of each rotational pair of the proximal link hub 12 and the proximal end link member 15, and the proximal end link member 15 and the central link member 17 (FIG. 5A)
  • the angle ⁇ formed by the central axis O2 of each rotating pair is 90°. However, the angle ⁇ may be other than 90°.
  • the three sets of link mechanisms 14 have the same geometric shape.
  • geometrically the same shape means a geometric model in which each link member 15, 16, 17 is expressed by a straight line, that is, each rotating pair and a straight line connecting these rotating pairs.
  • FIG. 6 is a diagram depicting one set of link mechanisms 14 in straight lines.
  • the parallel link mechanism 9 of this embodiment is of a rotationally symmetrical type, with a link hub 12 on the proximal side and an end link member 15 on the proximal side, and a link hub 13 on the distal side and an end link member 16 on the distal side.
  • the positional relationship is rotationally symmetrical with respect to the center line C of the central link member 17.
  • the center portion of each central link member 17 is located on a common orbital circle D.
  • the link hub 12 on the proximal end side, the link hub 13 on the distal end side, and the three sets of link mechanisms 14 create a two-free structure in which the link hub 13 on the distal side is rotatable about two orthogonal axes with respect to the link hub 12 on the proximal end side.
  • a mechanism is configured.
  • the link hub 13 on the distal side with respect to the link hub 12 on the proximal side is configured as a mechanism that can freely change its posture with two rotational degrees of freedom.
  • this two-degree-of-freedom mechanism is compact, it is possible to have a wide movable range of the link hub 13 on the distal side relative to the link hub 12 on the proximal side.
  • each rotational pair of the link hubs 12, 13 on the proximal and distal sides and the end link members 15, 16 on the proximal and distal sides passes through the spherical link centers PA and PB on the proximal and distal sides. If the straight lines intersecting at right angles to the central axis O1 (FIG.
  • the maximum bending angle ⁇ max which is the maximum value of the bending angle ⁇ of the link hub 13 with respect to the central axis QB, can be approximately ⁇ 90°. Further, the turning angle ⁇ of the link hub 13 on the distal side with respect to the link hub 12 on the proximal side can be set in the range of 0° to 360°.
  • the bending angle ⁇ is the vertical angle at which the central axis QB of the link hub 13 on the distal end is inclined with respect to the central axis QA of the link hub 12 on the proximal end.
  • the turning angle ⁇ is the horizontal angle at which the central axis QB of the link hub 13 on the distal end is inclined with respect to the central axis QA of the link hub 12 on the proximal end.
  • the maximum bending angle ⁇ max may be 90° or more.
  • the posture change of the distal link hub 13 with respect to the proximal link hub 12 is performed using the intersection O between the central axis QA of the proximal link hub 12 and the central axis QB of the distal link hub 13 as the center of rotation. be exposed.
  • the solid line in FIG. 7 indicates that the central axis QA of the proximal link hub 12 and the central axis QB of the distal link hub 13 are on the same line, and the two-dot chain line in FIG. 7 indicates the proximal link.
  • a state is shown in which the central axis QB of the link hub 13 on the distal end side takes a certain operating angle (bending angle) with respect to the central axis QA of the hub 12.
  • FIG. 6 even if the attitude of the distal link hub 13 relative to the proximal link hub 12 changes, the distance L between the proximal and distal spherical link centers PA and PB does not change.
  • the parallel link mechanism 9 when all of the following conditions are satisfied, the link hub 12 on the proximal side and the end link member 15 on the proximal side due to geometric symmetry. , the distal link hub 13 and the distal end link member 16 move in the same manner. Therefore, when transmitting rotation from the proximal end to the distal end, the parallel link mechanism 9 functions as a constant velocity universal joint in which the proximal end and the distal end have the same rotation angle and rotate at a constant speed.
  • Condition 1 The angle of the central axis O1 of the rotation pair of the link hubs 12, 13 on the proximal side and distal side and the end link members 15, 16 on the proximal side and distal side in each link mechanism 14, and the proximal side and distal side.
  • the lengths from the side spherical link centers PA and PB are equal to each other.
  • Condition 2 The central axis O1 of the rotating pair of the link hubs 12 and 13 on the proximal and distal sides of each link mechanism 14 and the end link members 15 and 16 on the proximal and distal sides, and the central axis O1 on the proximal and distal sides.
  • the center axis O2 of the rotation pair of the end link members 15, 16 and the center link member 17 intersects the spherical link centers PA, PB on the base end side and the distal side on the base end side and the distal side.
  • Condition 3 The geometric shapes of the proximal end link member 15 and the distal end link member 16 are equal.
  • Condition 4 The geometric shapes of the proximal end portion and the distal end portion of the central link member 17 are equal.
  • Condition 5 With respect to the plane of symmetry of the central link member 17, the angular positional relationship between the central link member 17 and the end link members 15 and 16 on the proximal and distal sides is the same on the proximal and distal sides. .
  • the link hub 12 on the proximal end includes a flat proximal member 6 and three rotating shaft connecting members 21 provided integrally with the proximal member 6.
  • the base end member 6 has a circular through hole 6a in the center, and three rotating shaft connecting members 21 are arranged at equal intervals in the circumferential direction around the through hole 6a. There is.
  • the center of the through hole 6a is located on the central axis QA of the link hub 12 on the proximal end side shown in FIG.
  • a rotating shaft 22 shown in FIG. 5A whose axis intersects with the central axis QA of the link hub 12 on the proximal end side is rotatably connected to each rotating shaft connecting member 21.
  • One end of the proximal end link member 15 is connected to this rotating shaft 22 .
  • the rotating shaft 22 has a large diameter portion 22a, a small diameter portion 22b, and a male threaded portion 22c sequentially along the axial direction, and is rotatably attached to the rotating shaft connecting member 21 via two bearings 23 at the small diameter portion 22b.
  • the bearing 23 is, for example, a ball bearing such as a deep groove ball bearing or an angular contact ball bearing. These bearings 23 are installed and fixed with the outer peripheral surface of the outer ring fitted into an inner diameter groove provided in the rotating shaft connecting member 21. The types and installation methods of bearings provided in other rotating pairs are also similar.
  • the rotating shaft 22 has a large diameter portion 22a and is arranged coaxially with an output shaft 52a of a deceleration mechanism 52, which will be described later.
  • One end of the proximal end link member 15 is connected to the rotating shaft 22 so as to rotate together with the rotating shaft 22 .
  • a notch 25 is formed at one end of the end link member 15 on the proximal side, and both side portions of the notch 25 constitute a pair of inner and outer rotating shaft support parts 26 and 27.
  • a through hole is formed in each of the pair of rotating shaft support parts 26 and 27.
  • the rotating shaft connecting member 21 is disposed within the notch 25, and the small diameter portion 22b of the rotating shaft 22 is inserted through the through hole and the inner circumferential surface of the inner ring of the bearing 23.
  • the male threaded portion 22c of the rotating shaft 22 projects further inward than the inner rotating shaft support portion 27.
  • a spacer 28 is fitted to the outer periphery of the large diameter portion 22a of the rotating shaft 22, and the proximal end link member 15 and the output shaft 52a of the deceleration mechanism 52 are fixed with bolts 29 via the spacer 28. . Further, a nut is screwed onto the male threaded portion 22c of the rotating shaft 22. A spacer is interposed between the inner ring end surface of the bearing 23 and the pair of rotating shaft support parts 26 and 27, and a preload is applied to the bearing 23 when the nut is screwed on.
  • a rotating shaft 35 rotatably connected to one end of the central link member 17 is connected to the other end of the end link member 15 on the base end side. Similar to the rotating shaft 22 of the link hub 12 (FIG. 5B) on the proximal end side, this rotating shaft 35 has a large diameter portion 35a, a small diameter portion 35b, and a male threaded portion 35c, and the small diameter portion 35b has two bearings. It is rotatably supported at one end of the central link member 17 via 36.
  • a notch 37 is formed at the other end of the end link member 15 on the proximal side, and both side portions of the notch 37 constitute a pair of inner and outer rotating shaft support parts 38 and 39. Through holes are formed in these rotating shaft support parts 38 and 39, respectively.
  • the male threaded portion 35c projects further inward than the inner rotating shaft support portion 39.
  • One end of the central link member 17 is disposed within the notch 37, and the small diameter portion 35b is inserted into the through hole and the inner peripheral surface of the inner ring of the bearing 36. Further, a nut is screwed onto the male threaded portion 35c. A spacer is interposed between the inner ring end surface of the bearing 36 and the pair of rotating shaft support parts 38 and 39, and a preload is applied to the bearing 36 when the nut is screwed on.
  • the link hub 13 on the distal end side has a flat distal end member 40 and three rotary shaft connecting members 41 provided on the bottom surface of the distal end member 40 at equal intervals in the circumferential direction. .
  • the center of the circumference on which each rotary shaft connecting member 41 is arranged is located on the central axis QB (FIG. 4) of the link hub 13 on the distal end side.
  • Each rotary shaft connecting member 41 is rotatably connected to a rotary shaft 43 whose axis intersects with the central axis QB shown in FIG. 7 of the link hub 13 on the distal end side.
  • one end of the end link member 16 on the distal end side is connected to this rotating shaft 43.
  • a rotating shaft 45 rotatably connected to the other end of the central link member 17 is connected to the other end of the end link member 16 on the tip side.
  • the rotation shaft 43 of the link hub 13 on the distal end side and the rotation shaft 45 of the central link member 17 also have the same shape as the rotation shaft 35 (FIG. 5A), and are connected to the rotation shaft via two bearings (not shown). It is rotatably connected to the other ends of the connecting member 41 and the central link member 17, respectively.
  • the posture control actuator 10 is a rotary actuator consisting of a servo motor equipped with a deceleration mechanism 52, and is installed on the surface of the base end member 6 of the link hub 12 on the base end side coaxially with the rotation axis 22 shown in FIG. 5A. has been done.
  • the attitude control actuator 10 in FIG. 5B and the deceleration mechanism 52 shown in FIG. 5A are integrally provided, and the deceleration mechanism 52 is fixed to the base end member 6 in FIG. 5B by a motor fixing member 53.
  • the attitude control actuator 10 may be equipped with a brake.
  • the posture control actuators 10 are provided in all three link mechanisms 14, but if the posture control actuators 10 are provided in at least two of the three link mechanisms 14, the proximal end side
  • the attitude of the link hub 13 (FIG. 3) on the distal end side with respect to the link hub 12 can be determined.
  • the three posture control actuators 10 are arranged such that their rotation axes 22 (FIG. 5A) are orthogonal to the central axis QA (FIG. 4) of the proximal link hub 12, and the rotation of these posture control actuators 10 is A central position P 10 , which is the intersection of the axes 22 (FIG. 5A), is on the central axis QA (FIG. 4) of the proximal link hub 12. Further, the bisector of the rotation axis 22 (FIG. 5A) of two of the three posture control actuators 10 is the same as the rotation axis 22 (FIG. 5A) of the rotation actuator 10 and the link hub on the base end side. It lies on the plane formed by the central axis QA of No.
  • the bisector is perpendicular to the axial center of the "rotary shaft 22" shown in FIG. 5A, and is in the longitudinal direction of the base end of the large diameter section 22a and the tip of the male screw section 22c of the "rotary shaft 22". This is a line passing through the middle part. Further, the bisector is located on the acute angle side of the angle formed by the rotation axis 22 of the rotary actuator 10 (FIG. 5B) and the central axis QA (FIG. 4) of the proximal link hub 12 (FIG. 5B). .
  • the speed reduction mechanism 52 has a flange output and a large diameter output shaft 52a.
  • the distal end surface of the output shaft 52a is a planar flange surface 54 that is perpendicular to the center line of the output shaft 52a.
  • the output shaft 52a is connected to the rotary shaft support portion 26 of the end link member 15 on the base end side with a bolt 29 via the spacer 28.
  • a large diameter portion 22a of the rotating shaft 22, which constitutes a rotating pair of the proximal link hub 12 (FIG. 4) and the proximal end link member 15, is provided on the output shaft 52a of the deceleration mechanism 52. It fits into the inner diameter groove 57.
  • the link actuating device 7 operates the parallel link mechanism 9 by rotationally driving each attitude control actuator 10. Specifically, when the attitude control actuator 10 is rotationally driven, the rotation is decelerated and transmitted to the rotating shaft 22 via the deceleration mechanism 52 in FIG. 5A. As a result, the angle of the proximal end link member 15 with respect to the proximal link hub 12 shown in FIG. 4 changes, and the attitude of the distal link hub 13 with respect to the proximal link hub 12 is arbitrarily changed. Ru.
  • An end effector (not shown) is attached to the tip member 40 of the link hub 13 on the tip side.
  • An end effector attached to the tip member 40 is configured to be movable by the attitude control actuator 10. Examples of the end effector include a hand including a gripper, a cleaning nozzle, a dispenser, a welding torch, and an image processing device.
  • the control device Cu changes the posture of the distal link hub 13 with respect to the proximal link hub 12 from the current posture to a target given from an external command means Ed external to the control device Cu.
  • Each attitude control actuator 10 is controlled to change the attitude.
  • the control device Cu is numerically controlled by a computer, and is mainly composed of attitude change control means 58.
  • the attitude change control means 58 is composed of a servo driver or a programmable logic controller (abbreviated as PLC), and each attitude control actuator 10 is electrically connected to an individual control unit 59 in the control device Cu.
  • the attitude change control means 58 normally changes the attitude of the link hub 13 on the distal end side from the current attitude to the final target attitude, which is the target attitude given by the external command means Ed, through a plurality of points on the way. (the amount of movement differs between points) is obtained by a predetermined calculation and registered, and commands are sequentially issued so as to sequentially move to each registered point.
  • a point calculation means (not shown) that calculates and registers the plurality of points by calculation is provided inside or outside the attitude change control means 58 and above the command conversion section 60, which will be described later.
  • the external command means Ed may command each point.
  • the control device Cu is connected to a host PLC, an external command means Ed such as an operation switch, or an operation device Ou such as a programmable display, and receives commands from the external command means Ed and the operation device Ou to control the link actuation device. 7 attitude control is performed.
  • the operating device Ou has a function of setting the operation pattern, control parameters, etc. of the tip member 40.
  • This operating device Ou has operating means 61 such as buttons for selecting and changing load conditions.
  • the load in the load condition is, for example, the load weight including the end effector and the workpiece mounted on the end effector.
  • the operating device Ou in FIG. 2 is capable of issuing commands to the control device Cu in FIG. It is possible to display the control parameters on the display unit 62 (FIG. 2) and to write and update the control parameters in the control device Cu.
  • the external command means Ed may be provided in the operating device Cu.
  • the control parameter may be simply referred to as a parameter or a parameter value.
  • the operating device Ou has a button 63a for switching the load condition from 1 to n (n: a natural number of 2 or more), and control parameters described below related to the jerk/acceleration of the tip member 40 (FIG. 3). It has a parameter display/numeric input section 63b that can display and input numerical values of a plurality of control parameters A to m, and a parameter write button 63c that writes a plurality of control parameters to the control device Cu (FIG. 1).
  • the plurality of control parameters A to m are linked to the load conditions 1 to n, as shown in FIG.
  • the numerical values of the control parameters A to m displayed on the display section 62 of the operating device Ou shown in FIG. A parameter switching command is also sent.
  • the posture change control means 58 changes each posture control actuator 10 from each rotation angle of the proximal end link member 15 in the current posture to the proximal end link member 15 in the target posture. This is means for driving the command arm by the rotation angle up to each of the 15 rotation angles.
  • the attitude change control means 58 includes an initial parameter generation rule section 65, a command conversion section 60, a synchronization control section 66, and an individual control section 59.
  • the initial parameter generation rule unit 65 includes a parameter storage unit 65a and a parameter switching unit 65b.
  • the parameter storage unit 65a stores a plurality of parameter values related to jerk/acceleration for each load condition, and the parameter values can be updated from the operating device Ou or the external command means Ed.
  • the parameters in the parameter storage section 65a may include non-writable parameters that are not displayed on the operating device Ou or the external command means Ed, and cannot be updated from the operating device Ou or the external command means Ed.
  • the parameter switching means 65b switches the control parameters to adjust the jerk and acceleration of the attitude control actuator 10 or the tip member 40 in accordance with the load acting on the tip member 40. Specifically, the parameter switching unit 65b calls the parameters corresponding to the load conditions 1 to n commanded from the operating device O or the external command unit Ed from the parameter storage unit 65a, and reads the parameters from the initial parameter generation unit 60a of the command conversion unit 60. Send as a rule.
  • control parameters A to m related to jerk/acceleration include acceleration time, deceleration time, maximum speed at command speed, filter time constant, moment of inertia ratio, position loop gain, speed loop gain, speed loop integral time constant, etc. However, it is not limited to this example.
  • FIG. 9A shows velocity and acceleration waveforms for reference when no filter time constant is set. If the filter time constant is not set as a control parameter, a sudden change in acceleration occurs (that is, the jerk is large) during acceleration to the command speed V and deceleration upon completion of attitude control. Therefore, when the mounted weight, which is a load, is large, vibrations during operation and settling become large.
  • the acceleration range from a stopped state to uniform motion of the parallel link mechanism, or vice versa, the deceleration from uniform motion to a stopped state of the parallel link mechanism. This region is called "settling time.”
  • FIG. 9B shows the velocity waveform and acceleration waveform when the filter time constant is set according to this embodiment.
  • the acceleration time ta' and deceleration time tc' in FIG. 9B are made shorter than the acceleration time ta and deceleration time tc in FIG. 9A, or the maximum acceleration A' in FIG. 9B is made larger than the maximum acceleration A in FIG. 9A.
  • the commanded speed V may be increased, or one or more of these may be used in combination. This enables high-speed operation while reducing vibration during operation and settling.
  • the attitude change control means 58A of the link actuating device changes the position of the distal end side link hub 13 (FIG. 3) at its current position; It recognizes the posture and calculates the position and posture at the commanded target position. After these calculations, the attitude change control means 58A determines the actual attitude control actuator 10 (FIG. 3), which is a servo motor M connected to the control device, from the distance to the target position, command speed, acceleration time, and deceleration time. The moving amount and moving speed are calculated and output to the servo motor M as a speed command and a position command.
  • the attitude change control means 58A adds the output command information, feedback information of the current position from the encoder E of the servo motor M, and feedback information of the current movement speed, while controlling the position control unit 59a, the speed control unit 67, and The current control section 68 adjusts the proportional gain, integral gain, and differential gain, respectively.
  • a power converter 69 is provided after the current controller 68, and the power converter 69 converts the current into predetermined alternating current power.
  • the model following control section 70 increases the responsiveness of the servo motor E by adding a model following control gain to the position control section 59a, a speed feedforward to the speed control section 67, and a torque feedforward to the current control section 68. can be improved.
  • the command conversion unit 60 receives a target attitude command B ( ⁇ b, ⁇ b) given by the bending angle ⁇ and the turning angle ⁇ from the external command means Ed via the point calculation means or directly.
  • the difference between the angle ⁇ n ( ⁇ 1 to ⁇ 3) and each current rotation angle ⁇ becomes the command arm rotation angle.
  • the calculation for determining the rotation angle ⁇ of the end link member 15 on the proximal end side of each link mechanism 14 from the bending angle ⁇ and the turning angle ⁇ is performed by inverse transformation using a predetermined relational expression (1).
  • is the connecting end shaft of the central link member 17 rotatably connected to the end link member 15 on the proximal end side, and the connecting end shaft of the central link member 17 rotatably connected to the end link member 15 on the distal end side.
  • ⁇ n ( ⁇ 1, ⁇ 2, ⁇ 3) is the separation angle in the circumferential direction of each proximal end link member 15 with respect to the reference proximal end link member 15.
  • the separation angles ⁇ 1, ⁇ 2, ⁇ 3 of the end link members 15 on the proximal end side in the circumferential direction are respectively They are 0°, 120°, and 240°.
  • the arm rotation angles corresponding to postures A and B are the arm rotation angles of the arm in posture A, respectively.
  • the command conversion section 60 includes an initial parameter generation section 60a and a judgment/change section 60b in addition to the means having the basic functions.
  • the command arm rotation angle obtained by conversion by the command conversion unit 60 is given to each individual control unit 59 corresponding to each attitude control actuator 10 via a synchronization control unit 66. That is, initial parameters are generated, predetermined judgments and changes are made within the command conversion unit 60, and the velocity between each point and the coordinates of each attitude control actuator (motor position) are calculated in advance.
  • the synchronous control unit 66 is a means for synchronously controlling the rotation of each proximal end link member 15, and transmits hourly position commands to the individual control unit 59, which is an actuator driver, in accordance with the synchronization timing. .
  • the individual control section 59 drives the corresponding posture control actuator 10 in accordance with the commands from the synchronization control section 66 .
  • the synchronization control section 66 has a parameter setting section 66a and a position setting section 66b that respectively set parameters and positions specified for each individual control section 59. When changing the control parameters that were previously set, set the changed control parameters.
  • the position setting section 66b sets the command arm rotation angle.
  • Each individual control unit 59 is a means for controlling the operation of the corresponding attitude control actuator 10 to rotate the end link member 15 on the proximal end side from the current angle to the target angle, and is a position control unit composed of a servo driver. It has a control section 59a and a command execution means 59b.
  • the synchronization control section 66 gives an operation command to the position control section 59a by issuing pulses or the like in accordance with each control parameter and arm command rotation angle, and the command execution means 59b drives the posture control actuator 10.
  • the position control section 59a performs feedback control using the given operation command and the detected value of the encoder E (FIG. 10B), which is a rotation angle detection means.
  • the initial parameter generation unit 60a of the command conversion unit 60 causes the end link members 15 on the proximal end to simultaneously start rotating by the command arm rotation angle of the end link members 15 on the proximal end given from a higher level.
  • a control parameter for controlling rotation so as to stop is generated as an initial value of the control parameter according to a predetermined rule.
  • the initial parameter generation unit 60a sets the acceleration time and deceleration time among the control parameters to one period of the resonance frequency of the link actuating device 7.
  • the resonant frequency referred to here is the resonant frequency when all mounted objects such as the end effector are installed on the link hub 13 on the distal end side.
  • the judgment/change unit 60b is a means for judging the control parameters generated by the initial parameter generation unit 60a based on predetermined criteria, and changing them if it is determined that they should be changed.
  • the judgment/change unit 60b includes an operation time estimation means 60ba, a condition selection means 60bb, and a parameter change means 60bc.
  • the operation time estimating means 60ba estimates the operation time from the acceleration time, deceleration time, command speed, and command arm rotation angle of the attitude control actuator 10.
  • the condition selection means 60bb is a means for comparing this estimated operation time with the sum of the acceleration time and deceleration time.
  • the parameter changing means 60bc changes the initial value of the control parameter based on the comparison result by the condition selecting means 60bb.
  • the link actuating device 7 adopts a parallel link mechanism 9, and there is no need to arrange a servo motor in the movable part, and since the movable part is lightweight, it is possible to increase jerk and perform fine movements at high speed. I'm good at it.
  • the jerk greatly affects the speed, that is, the takt time, and as the mounted weight increases, the movable parts become heavier and vibrations are more likely to occur. Therefore, the control parameters are set to adjust the jerk.
  • the parameter switching means 65b for switching becomes more effective.
  • the parameter switching means 65b switches a plurality of control parameters including at least one of the filter time constant and model following control gain of the moving average filter.
  • the jerk can be decreased, so that the shock generated by the change in acceleration is decreased. Therefore, when the onboard weight (load) is large, these control parameters are changed by the parameter switching means 65b so as to increase the filter time constant of the moving average filter or to decrease the model following control gain.
  • the vibration during settling and the torque of the actuator 10 can be reduced without reducing the speed of the parallel link mechanism 9, and the vibration of the tip member 40 during settling and during operation can be reduced.
  • the parameter switching means 65b switches a plurality of control parameters for adjusting the acceleration of the attitude control actuator 10 or the tip member 40.
  • the adjustment range of the control parameters is expanded, and vibrations during settling and during operation can be reduced without reducing the speed of the link actuating device 7.
  • the torque of the attitude control actuator 10 can be reduced.
  • the plurality of control parameters for adjusting the acceleration include at least one of acceleration time, deceleration time, and command speed. If the control parameters related to acceleration include at least one of acceleration time, deceleration time, and command speed, acceleration can be easily adjusted.
  • the parameter switching means 65b may reduce the jerk and increase the acceleration as the load increases. Since the impact on the tip member 40 of the link actuating device 7 is influenced more by jerk than by acceleration, by adjusting the control parameters in this way, it becomes possible to operate the link actuating device 7 at higher speed. .
  • the link actuating device 7 includes an operating device Ou that sets the operation pattern and control parameters of the tip member 40, and the operating device Ou in FIG. 2 has an operating means 61 that selects and changes load conditions.
  • the operation means 61 of the operation device Ou not only sets the operation pattern and control parameters of the control device Cu shown in FIG. 1, but also easily changes the control parameters to values according to the load conditions. You will be able to switch to
  • a parallel link mechanism 9 may be used in which the arm length L1 on the proximal end side is longer than the arm length L2 on the distal end side.
  • the arm length L1 on the proximal end is determined by the distance between the axial center point Pa of the rotation pair axis of the proximal end link member 15 and the proximal link hub 12, and the spherical link center PA on the proximal end. It is distance.
  • the arm length L2 on the distal end side is the distance between the center point Pb in the axial direction of the pair of rotating shafts of the end link member 16 on the distal end side and the link hub 13 on the distal end side, and the center PB of the spherical link on the distal end side. . Also in the link actuating device having this parallel link mechanism 9, by providing the same control device Cu as described above, it is possible to cope with a wide range of loading weights and increase versatility.
  • the control device Cu controls the posture of the link hub 13 on the distal side with respect to the link hub 12 on the proximal side by rotating the three rotating bodies 71 with the posture control actuator 10.
  • the three rotating bodies 71 are coaxially and rotatably supported by the link hub 12 on the base end side.
  • Pulleys 72 are each supported on the rotating shaft of the attitude control actuator 10, and a belt 73 is stretched between each of the three pulleys 72 and each rotating body 71.
  • the pulley 72 is rotated, and by rotating the rotating body 71 via the belt 73, the attitude of the link hub 13 on the distal end side can be controlled.
  • the link actuating device having this parallel link mechanism 9 by providing the same control device Cu as described above, it is possible to cope with a wide range of loading weights and increase versatility.
  • a machine tool 74A shown in FIG. 13A may be applied as the industrial equipment.
  • This machine tool 74A includes a linear motion unit 76 that moves forward and backward in two axes (X, Z axes) orthogonal to a gate-shaped pedestal 75, and a Y axis that is orthogonal to the X and Z axes below the linear motion unit 76.
  • a transport mechanism 77 capable of transporting in the axial direction is provided.
  • a tool TL capable of machining the workpiece W is attached to a movement drive actuator 10 serving as an output section of the linear motion unit 76 , and the workpiece W is attached to a conveyance table of the conveyance mechanism 77 .
  • the actuator 10 and the transport mechanism 77 are synchronously controlled by a control device Cu.
  • a control device similar to that described above as the control device Cu that controls the actuator 10 and the like By applying a control device similar to that described above as the control device Cu that controls the actuator 10 and the like, a machine tool that can handle a wide range of loading weights and has increased versatility can be realized.
  • a machine tool 74B shown in FIG. 13B may be applied as the industrial equipment.
  • a rotation drive mechanism 78 that supports the workpiece W rotatably around the X-axis, for example, is installed.
  • the same control device as described above as the control device Cu for controlling the actuator 10 and the like it is possible to realize a machine tool that can handle a wide range of loading weights and has increased versatility.
  • any configuration that can control the bending angle ⁇ and the turning angle ⁇ may be used, so a pan/tilt configuration (not shown) may be applied as the actuating mechanism. good.
  • a vertically articulated robot or a horizontally articulated robot may be applied as the industrial equipment.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

制御装置(Cu)は、姿勢制御用アクチュエータ(10)により先端部材(40)が移動可能に設けられたリンク作動装置(7)における、姿勢制御用アクチュエータ(10)を制御する。パラレルリンク機構は、基端側のリンクハブ(12)に対し先端側のリンクハブ(13)を3組のリンク機構(14)を介して姿勢変更可能に連結したものである。制御装置(Cu)は、先端部材(40)に作用する負荷に応じて、姿勢制御用アクチュエータ(10)または先端部材(40)の加加速度を調整するように制御パラメータを切り替えるパラメータ切替手段(65b)を備えている。パラメータ切替手段(65b)は、移動平均フィルタのフィルタ時定数およびモデル追従制御ゲインの少なくともいずれか1つを含む複数の制御パラメータを切り替える。

Description

産業機器の制御装置 関連出願
 本出願は、2022年3月29日出願の特願2022-053430の優先権を主張するものであり、その全体を参照により本願の一部をなすものとして引用する。
 本発明は、例えば、医療機器または外観検査装置のような産業機器等の高速、高精度および広範な作動範囲を必要とする産業機器の制御装置に関する。
 特許文献1では、ベースプレートとトラベリングプレートとを有し、両者の間を複数のリンクで結合し、これらのリンクを協調動作させることによりトラベリングプレートを移動させるパラレルリンク機構によって所定の作業を行う作業装置が提案されている。
 特許文献2では、コンパクトでありながら、高速、高精度で、広範な作動範囲の動作が可能なリンク作動装置が提案されている。
特開2000-94245号公報 米国特許第5893296号明細書
 特許文献1のパラレルリンク機構では、各リンクの作動角が小さいため、トラベリングプレートの作動範囲を大きく設定するためには、リンク長さを長くする必要がある。このリンク長さが長くなることにより、機構全体の寸法が大きくなって装置が大型になってしまうという課題があった。また、リンク長さを長くすると、機構全体の剛性の低下を招くだけでなく、トラベリングプレートにツール等を搭載した場合に、搭載物の慣性モーメントが大きくなり、トラベリングプレートに搭載されるツールの重量、つまりトラベリングプレートの可搬重量も小さいものに制限されるという課題もあった。
 特許文献2に示すパラレルリンク機構およびリンク作動装置の構成では、細かい姿勢変更を高速に行えるが、以下の課題があった。姿勢制御用アクチュエータの回転角度に対して先端側のリンクハブの姿勢が2倍動く増速機構のため、重量が大きいものを搭載すると、整定時の振動が大きくなり、高速動作を行うには搭載重量(負荷)が小さいものに制限されるという課題があった。
 本発明の目的は、幅広い搭載重量に対応でき汎用性を高めることができる産業機器の制御装置を提供することである。
 以下、本発明について、理解を容易にするために、便宜上実施形態の符号を参照して説明する。
 本発明の産業機器の制御装置は、アクチュエータ10により先端部材40が移動可能に設けられた産業機器における、前記アクチュエータ10を制御する産業機器の制御装置Cuであって、
 前記先端部材40に作用する負荷に応じて、前記アクチュエータ10または前記先端部材40の加加速度を調整するように制御パラメータを切り替えるパラメータ切替手段65bを備えている。
 前記「加加速度」とは、単位時間あたりの加速度の変化率であり、「ジャーク」または「躍度」とも呼ばれる。
 この構成によると、例えば、搭載重量等の負荷の増加時に加加速度を小さくすることで、産業機器の先端部材40の動作中および整定時の振動を小さくすることができる。したがって、指令速度を低下させることなく加加速度を調整するため、高速動作を実現しながら、1つの機械体で幅広い搭載重量に対応することができるようになる。これにより産業機器の汎用性を高めることができる。
 前記産業機器はリンク作動装置7であり、このリンク作動装置7は、基端側のリンクハブ12に対し先端側のリンクハブ13が3組以上のリンク機構14を介して姿勢を変更可能に連結され、前記各リンク機構14が、それぞれ前記基端側のリンクハブ12および前記先端側のリンクハブ13に一端が回転可能に連結された基端側および先端側の端部リンク部材15,16と、これら基端側および先端側の端部リンク部材15,16の他端に両端がそれぞれ回転可能に連結された中央リンク部材17とを有し、前記3組以上のリンク機構14のうちの2組以上のリンク機構14に、前記基端側のリンクハブ12に対する前記先端側のリンクハブ13の姿勢を任意に変更させる姿勢制御用の前記アクチュエータ10が設けられていてもよい。
 この構成によると、リンク作動装置7は、パラレルリンク機構を採用しており、可動部にサーボモータを配置する必要がなく、可動部が軽量のため、加加速度を大きくして、細かい動作を高速で行うことが得意である。このようなリンク作動装置7では、加加速度が速度つまりタクトタイムに大きく影響し、搭載重量を増加させると可動部が重たくなって振動が発生しやすくなるため、加加速度を調整するように制御パラメータを切り替えるパラメータ切替手段65bがより有効になる。
 前記パラメータ切替手段65bは、移動平均フィルタのフィルタ時定数およびモデル追従制御ゲインの少なくともいずれか1つを含む複数の制御パラメータを切り替えてもよい。この場合、移動平均フィルタのフィルタ時定数を大きくする、または、モデル追従制御ゲインを小さくすることで、加加速度を小さくできるため、加速度の変化により発生する衝撃が小さくなる。そのため、搭載重量(負荷)が大きい場合に、移動平均フィルタのフィルタ時定数を大きくする、または、モデル追従制御ゲインを小さくするように、パラメータ切替手段65bでこれらの制御パラメータを変更する。これにより、産業機器の速度を低下させることなく、整定時の振動およびアクチュエータ10のトルクを低減でき、整定時および動作中の先端部材40の振動を小さくできる。
 また、通常の制御では、移動平均フィルタによる加速度の連続的な変化を考慮していないため、この加速度の連続的な変化を外乱による影響とみなし、自動制御ループを自動で調整するため、意図した結果が得られないことがある。このような場合には、移動平均フィルタのフィルタ時定数だけでなく、モデル追従制御ゲインと合わせて調整すれば、通常時の指令のような直線形を理想形として、位置制御、速度制御、電流制御を負荷の大きさに応じた理想形に近づくように制御できるようになる。これにより、振動・衝撃の発生を抑制し、整定時間の減少および最大速度の維持を実現することができる。
 前記パラメータ切替手段65bは、前記アクチュエータ10または前記先端部材40の加速度を調整する複数の制御パラメータを切り替えてもよい。この場合、搭載重量に応じて、加加速度だけでなく、加速度を調整することで、制御パラメータの調整幅が広がり、産業機器の速度を低下させることなく、整定時および動作中の振動およびアクチュエータ10のトルクを低減できる。
 前記加速度を調整する複数の制御パラメータは、加速時間、減速時間および指令速度のうち、少なくともいずれか1つを含んでもよい。加速度に関わる制御パラメータを、加速時間、減速時間および指令速度のうち、少なくともいずれか1つを含むようにすれば、加速度を簡単に調整することができる。
 前記パラメータ切替手段65bは、前記負荷が大きい程、前記加加速度を小さくし、前記加速度を大きくしてもよい。産業機器の先端部材40に与える衝撃は、加速度よりも加加速度の影響が大きいため、このように制御パラメータを調整することで、より高速に産業機器を動作させることが可能になる。
 前記産業機器は、少なくとも前記先端部材40の動作パターンおよび前記制御パラメータを設定する操作装置Ouを備え、この操作装置Ouは、負荷条件を選択および変更する操作手段61を有してもよい。この場合、操作装置Ouの操作手段61により、制御装置Cuの動作パターンおよび制御パラメータ等を設定するだけでなく、負荷条件に合わせて、制御パラメータを、負荷条件に応じた値に簡単に切り替えることができるようになる。
 請求の範囲および/または明細書および/または図面に開示された少なくとも2つの構成のどのような組合せも、本発明に含まれる。特に、請求の範囲の各請求項の2つ以上のどのような組合せも、本発明に含まれる。
 本発明は、添付の図面を参考にした以下の好適な実施形態の説明から、より明瞭に理解されるであろう。しかしながら、実施形態および図面は単なる図示および説明のためのものであり、本発明の範囲を定めるために利用されるべきものではない。本発明の範囲は添付の請求の範囲によって定まる。添付図面において、複数の図面における同一の符号は、同一または相当する部分を示す。
本発明の第1の実施形態に係るリンク作動装置の制御装置のブロック図とその制御対象となるリンク作動装置の斜視図である。 同制御装置の操作装置の正面図である。 同リンク作動装置の斜視図である。 同リンク作動装置の2つのリンク機構を省略した簡易モデルの正面図である。 図5Bの一点鎖線で囲まれた部分の拡大図である。 図4のVA-VA線の一部断面図である。 同リンク作動装置の1つのリンク機構を直線で表現した図である。 同リンク作動装置の最大折れ角等を示す図である。 同リンク作動装置の負荷条件と制御パラメータとの関係を示す図である。 フィルタ時定数を設定しなかった場合の速度波形等を参考に示す図である。 同制御装置においてフィルタ時定数を設定した場合の速度波形等を示す図である。 フィルタ時定数を設定しなかった場合の制御系のブロック図である。 同制御装置においてフィルタ時定数を設定した場合の制御系のブロック図である。 本発明の第2の実施形態に係るリンク作動装置等の正面図である。 本発明の第3の実施形態に係るリンク作動装置等の斜視図である。 本発明の第4の実施形態に係る産業機器等の正面図である。 本発明の第5の実施形態に係る産業機器等の正面図である。
 [第1の実施形態]
 本発明の実施形態に係る産業機器の制御装置を図1ないし図10Bと共に説明する。
 図1に示すように、本実施形態では、先ず制御対象となる産業機器としてリンク作動装置7を説明し、その後、このリンク作動装置7の制御装置Cuおよび図2に示す操作装置Ouを説明する。以下の説明は産業機器の制御方法についての説明も含む。
 <リンク作動装置>
 図3に示すように、リンク作動装置7は、パラレルリンク機構9と、このパラレルリンク機構9を作動させる姿勢制御用アクチュエータ(アクチュエータ)10と、後述する操作装置Ou(図2)とを備える。
 <パラレルリンク機構>
 パラレルリンク機構9は、基端側のリンクハブ12に対し先端側のリンクハブ13を3組のリンク機構14を介して姿勢変更可能に連結したものである。リンク機構14の組数は4組以上であってもよい。図4では、1組のリンク機構14のみが示され、残りの2つのリンク機構が省略されている。
 各リンク機構14は、基端側の端部リンク部材15、先端側の端部リンク部材16、および中央リンク部材17を有し、4つの回転対偶からなる4節連鎖のリンク機構をなす。
 図3のように、基端側および先端側の端部リンク部材15,16はL字形状であり、一端がそれぞれ基端側のリンクハブ12および先端側のリンクハブ13に回転可能に連結されている。中央リンク部材17は、両端に基端側および先端側の端部リンク部材15,16の他端がそれぞれ回転可能に連結されている。
 図4に示すように、パラレルリンク機構9は、2つの球面リンク機構を組み合わせた構造である。基端側のリンクハブ12と基端側の端部リンク部材15の各回転対偶、および基端側の端部リンク部材15と中央リンク部材17の各回転対偶の中心軸が、基端側の球面リンク中心PAで交差している。同様に、先端側のリンクハブ13と先端側の端部リンク部材16の各回転対偶、および先端側の端部リンク部材16と中央リンク部材17の各回転対偶の中心軸が、先端側の球面リンク中心PBで交差している。
 また、基端側のリンクハブ12と基端側の端部リンク部材15との回転対偶の中心と基端側の球面リンク中心PA間の距離は同じである。基端側の端部リンク部材15と中央リンク部材17との回転対偶の中心と基端側の球面リンク中心PA間の距離は同じである。同様に、先端側のリンクハブ13と先端側の端部リンク部材16との回転対偶の中心と先端側の球面リンク中心PB間の距離は同じである。先端側の端部リンク部材16と中央リンク部材17との回転対偶の中心と先端側の球面リンク中心PB間の距離は同じである。基端側および先端側の端部リンク部材15,16と中央リンク部材17との各回転対偶の中心軸は、ある交差角γを持っていてもよいし、平行であってもよい。
 図5Bに、基端側のリンクハブ12と基端側の端部リンク部材15の各回転対偶の中心軸O1と、球面リンク中心PAとの関係が示されている。先端側のリンクハブ13(図4)および先端側の端部リンク部材16(図4)の形状ならびに位置関係も、図示しないが図5Bと同様である。図5Bでは、基端側のリンクハブ12と基端側の端部リンク部材15との各回転対偶の中心軸O1と、基端側の端部リンク部材15と中央リンク部材17(図5A)との各回転対偶の中心軸O2とが成す角度αが90°となっている。但し、前記角度αは90°以外であってもよい。
 3組のリンク機構14は、幾何学的に同一形状をなす。幾何学的に同一形状とは、図6に示すように、各リンク部材15,16,17を直線で表現した幾何学モデル、すなわち各回転対偶と、これら回転対偶間を結ぶ直線とで表現したモデルが、どのような姿勢をとっていても、中央リンク部材17の中央部に対する基端側部分と先端側部分が対称を成す形状であることを言う。図6は、1組のリンク機構14を直線で表現した図である。この実施形態のパラレルリンク機構9は回転対称タイプで、基端側のリンクハブ12および基端側の端部リンク部材15と、先端側のリンクハブ13および先端側の端部リンク部材16との位置関係が、中央リンク部材17の中心線Cに対して回転対称となる位置構成になっている。各中央リンク部材17の中央部は、共通の軌道円D上に位置している。
 基端側のリンクハブ12と先端側のリンクハブ13と3組のリンク機構14とで、基端側のリンクハブ12に対し先端側のリンクハブ13が直交2軸周りに回転自在な2自由度機構が構成されている。言い換えると、基端側のリンクハブ12に対して先端側のリンクハブ13を、回転が2自由度で姿勢変更自在な機構としている。この2自由度機構は、コンパクトでありながら、基端側のリンクハブ12に対する先端側のリンクハブ13の可動範囲を広くとれる。
 例えば、基端側および先端側の球面リンク中心PA,PBを通り、基端側および先端側のリンクハブ12,13と基端側および先端側の端部リンク部材15,16の各回転対偶の中心軸O1(図5B)と直角に交わる直線を基端側および先端側のリンクハブ12,13の中心軸QA,QBとした場合、基端側のリンクハブ12の中心軸QAと先端側のリンクハブ13の中心軸QBとの折れ角θの最大値である最大折れ角θmaxを約±90°とすることができる。また、基端側のリンクハブ12に対する先端側のリンクハブ13の旋回角φを0°~360°の範囲に設定できる。折れ角θは、基端側のリンクハブ12の中心軸QAに対して先端側のリンクハブ13の中心軸QBが傾斜した垂直角度のことである。一方、旋回角φは、基端側のリンクハブ12の中心軸QAに対して先端側のリンクハブ13の中心軸QBが傾斜した水平角度のことである。なお最大折れ角θmaxが90°以上であってよい。
 基端側のリンクハブ12に対する先端側のリンクハブ13の姿勢変更は、基端側のリンクハブ12の中心軸QAと先端側のリンクハブ13の中心軸QBとの交点Oを回転中心として行われる。図7の実線は、基端側のリンクハブ12の中心軸QAと先端側のリンクハブ13の中心軸QBが同一線上にある状態を示し、図7の二点鎖線は、基端側のリンクハブ12の中心軸QAに対して先端側のリンクハブ13の中心軸QBが或る作動角(折れ角)をとった状態を示す。図6に示すように、基端側のリンクハブ12に対する先端側のリンクハブ13の姿勢が変化しても、基端側と先端側の球面リンク中心PA,PB間の距離Lは変化しない。
 図5Bおよび図6に示すように、このパラレルリンク機構9において、以下の各条件を全て満たすとき、幾何学的対称性から基端側のリンクハブ12および基端側の端部リンク部材15と、先端側のリンクハブ13および先端側の端部リンク部材16とは同じに動く。よって、パラレルリンク機構9は、基端側から先端側へ回転伝達を行う場合、基端側と先端側は同じ回転角になって等速で回転する等速自在継手として機能する。
 条件1:各リンク機構14における基端側および先端側のリンクハブ12,13と基端側および先端側の端部リンク部材15,16の回転対偶の中心軸O1の角度および基端側および先端側の球面リンク中心PA,PBからの長さが互いに等しい。
 条件2:各リンク機構14の基端側および先端側のリンクハブ12,13と基端側および先端側の端部リンク部材15,16の回転対偶の中心軸O1、および基端側および先端側の端部リンク部材15,16と中央リンク部材17の回転対偶の中心軸O2が、基端側および先端側において基端側および先端側の球面リンク中心PA,PBと交差する。
 条件3:基端側の端部リンク部材15と先端側の端部リンク部材16の幾何学的形状が等しい。
 条件4:中央リンク部材17における基端側部分と先端側部分の幾何学的形状が等しい。
 条件5:中央リンク部材17の対称面に対して、中央リンク部材17と基端側および先端側の端部リンク部材15,16との角度位置関係が基端側と先端側とで同じである。
 図3に示すように、基端側のリンクハブ12は、平板状の基端部材6と、この基端部材6と一体に設けられた3個の回転軸連結部材21とを有する。図5Bに示すように、基端部材6は中央部に円形の貫通孔6aを有し、この貫通孔6aの周囲に3個の回転軸連結部材21が円周方向に等間隔で配置されている。前記貫通孔6aの中心は、図4に示す基端側のリンクハブ12の中心軸QA上に位置する。各回転軸連結部材21には、軸心が基端側のリンクハブ12の中心軸QAと交差する図5Aに示す回転軸22が回転自在に連結されている。この回転軸22に、基端側の端部リンク部材15の一端が連結されている。
 回転軸22は、軸方向に沿って順次、大径部22a、小径部22b、および雄ねじ部22cを有し、小径部22bで2個の軸受23を介して回転軸連結部材21に回転自在に支持されている。軸受23は、例えば深溝玉軸受、アンギュラ玉軸受等の玉軸受である。これらの軸受23は、回転軸連結部材21に設けられた内径溝に外輪外周面が嵌合状態で設置され固定されている。他の回転対偶部に設けられる軸受の種類および設置方法も同様である。
 回転軸22は、大径部22aで後述の減速機構52の出力軸52aに同心軸上に配置されている。回転軸22には、この回転軸22と一体に回転するように、基端側の端部リンク部材15の一端が連結されている。基端側の端部リンク部材15の一端に切欠き部25が形成され、この切欠き部25の両側部分が内外一対の回転軸支持部26,27を構成している。これら一対の回転軸支持部26,27に貫通孔がそれぞれ形成されている。回転軸連結部材21が切欠き部25内に配置され、回転軸22の小径部22bが前記貫通孔および軸受23の内輪内周面に挿通されている。回転軸22の雄ねじ部22cは、内側の回転軸支持部27よりも内側に突出している。
 回転軸22の大径部22aの外周にスペーサ28が嵌合され、このスペーサ28を介して基端側の端部リンク部材15と減速機構52の出力軸52aとがボルト29で固定されている。さらに、回転軸22の雄ねじ部22cにナットが螺着されている。軸受23の内輪端面と一対の回転軸支持部26,27との間に、スペーサが介在されており、前記ナットの螺着時に軸受23に予圧が付与される。
 基端側の端部リンク部材15の他端には、中央リンク部材17の一端に回転自在に連結された回転軸35が連結されている。この回転軸35は、基端側のリンクハブ12(図5B)の回転軸22と同様に、大径部35a、小径部35b、および雄ねじ部35cを有し、小径部35bで2個の軸受36を介して中央リンク部材17の一端に回転自在に支持されている。基端側の端部リンク部材15の他端に切欠き部37が形成され、この切欠き部37の両側部分が内外一対の回転軸支持部38,39を構成している。これら回転軸支持部38,39に貫通孔がそれぞれ形成されている。雄ねじ部35cは、内側の回転軸支持部39よりも内側に突出している。
 切欠き部37内に中央リンク部材17の一端が配置され、前記小径部35bが前記貫通孔および軸受36の内輪内周面に挿通されている。さらに、雄ねじ部35cにナットが螺着されている。軸受36の内輪端面と一対の回転軸支持部38,39との間に、スペーサが介在されており、前記ナットの螺着時に軸受36に予圧が付与される。
 図3に示すように、先端側のリンクハブ13は、平板状の先端部材40と、この先端部材40の底面に円周方向等配で設けられた3個の回転軸連結部材41とを有する。各回転軸連結部材41が配置される円周の中心は、先端側のリンクハブ13の中心軸QB(図4)上に位置する。各回転軸連結部材41には、軸心が先端側のリンクハブ13の図7に示す中心軸QBと交差する回転軸43が回転自在に連結されている。図3のように、この回転軸43に、先端側の端部リンク部材16の一端が連結されている。先端側の端部リンク部材16の他端には、中央リンク部材17の他端に回転自在に連結された回転軸45が連結されている。
 先端側のリンクハブ13の回転軸43および中央リンク部材17の回転軸45も、前記回転軸35(図5A)と同じ形状であり、かつ2個の軸受(図示せず)を介して回転軸連結部材41および中央リンク部材17の他端にそれぞれ回転自在に連結されている。
 <姿勢制御用アクチュエータ>
 姿勢制御用アクチュエータ10は、減速機構52を備えたサーボモータから成るロータリアクチュエータであり、基端側のリンクハブ12の基端部材6の表面に図5Aに示す前記回転軸22と同軸上に設置されている。図5Bの姿勢制御用アクチュエータ10と図5Aに示す減速機構52は一体に設けられ、モータ固定部材53により減速機構52が図5Bの基端部材6に固定されている。なお、姿勢制御用アクチュエータ10は、ブレーキ付きのものを使用してもよい。
 この例では、3組のリンク機構14のすべてに姿勢制御用アクチュエータ10が設けられているが、3組のリンク機構14のうち少なくとも2組に姿勢制御用アクチュエータ10を設ければ、基端側のリンクハブ12に対する先端側のリンクハブ13(図3)の姿勢を確定することができる。
 3つの姿勢制御用アクチュエータ10は、それらの回転軸22(図5A)が基端側リンクハブ12の中心軸QA(図4)と直交するように配置され、これらの姿勢制御用アクチュエータ10の回転軸22(図5A)の交点である中央位置P10が、基端側のリンクハブ12の中心軸QA(図4)上にある。また3つの姿勢制御用アクチュエータ10のうち2つの姿勢制御用アクチュエータ10の回転軸22(図5A)の二等分線が、回転アクチュエータ10の回転軸22(図5A)と基端側のリンクハブ12の中心軸QA(図4)が成す平面上にある。前記二等分線は、図5Aに示す「回転軸22」の軸心に直交し、且つ、「回転軸22」の大径部22aの基端部と雄ねじ部22cの先端部との長手方向中間部を通る線である。さらに、回転アクチュエータ10(図5B)の回転軸22と基端側のリンクハブ12(図5B)の中心軸QA(図4)が成す角度の鋭角側に前記二等分線が位置している。
 図5Aに示すように、減速機構52はフランジ出力であって、大径の出力軸52aを有する。出力軸52aの先端面は、出力軸52aの中心線と直交する平面状のフランジ面54となっている。出力軸52aは、前記スペーサ28を介して、基端側の端部リンク部材15の回転軸支持部26にボルト29で接続されている。基端側のリンクハブ12(図4)と基端側の端部リンク部材15の回転対偶部を構成する、回転軸22の大径部22aが、減速機構52の出力軸52aに設けられた内径溝57に嵌っている。
 図4に示すように、リンク作動装置7は、各姿勢制御用アクチュエータ10を回転駆動することで、パラレルリンク機構9が作動する。詳しくは、姿勢制御用アクチュエータ10を回転駆動すると、その回転が図5Aの減速機構52を介して減速して回転軸22に伝達される。それにより、図4に示す基端側のリンクハブ12に対する基端側の端部リンク部材15の角度が変わり、基端側のリンクハブ12に対する先端側のリンクハブ13の姿勢が任意に変更される。
 <エンドエフェクタについて>
 先端側のリンクハブ13の先端部材40には、図示外のエンドエフェクタが取り付けられている。先端部材40に取り付けられたエンドエフェクタが前記姿勢制御用アクチュエータ10により移動可能に構成される。エンドエフェクタは、例えば、グリッパを含むハンド、洗浄用ノズル、ディスペンサ、溶接トーチ、画像処理機器等が挙げられる。
 <制御装置および操作装置>
 図1に示すように、制御装置Cuは、基端側のリンクハブ12に対する先端側のリンクハブ13の姿勢を、現在の姿勢から、この制御装置Cuに対する外部の外部指令手段Edから与えられる目標姿勢へ変更するように、各姿勢制御用アクチュエータ10を制御する。制御装置Cuは、コンピュータによる数値制御式のものであり、主に姿勢変更制御手段58により構成される。姿勢変更制御手段58は、サーボドライバまたはプログラマブルロジックコントローラ(略称PLC)等で構成され、各姿勢制御用アクチュエータ10は、制御装置Cu内の個別制御部59に電気的に接続されている。
 姿勢変更制御手段58は、先端側のリンクハブ13を、外部指令手段Edから与えられた目標姿勢である最終目標姿勢へ現在の姿勢から姿勢変更させるにつき、通常は、途中で通過させる複数のポイント(ポイント間毎に移動量が異なる)を所定の演算により求めて登録しておき、各登録ポイントへ順次移動させるように、指令を順次行う。前記複数のポイントを演算により求めて登録する図示外のポイント演算手段は、姿勢変更制御手段58の内部または外部で、後述の指令変換部60の上位に設けられる。この他、外部指令手段Edが各ポイントを指令するようにしてもよい。
 制御装置Cuは、上位PLC、操作スイッチ等の外部指令手段Ed、またはプログラマブル表示機等の操作装置Ouと繋がっており、それら外部指令手段Ed、操作装置Ouから指令を受けることで、リンク作動装置7の姿勢制御を行う。操作装置Ouは、先端部材40の動作パターンおよび制御パラメータ等を設定する機能を有する。この操作装置Ouは、負荷条件を選択および変更するボタン等の操作手段61を有する。前記負荷条件における負荷とは、例えば、前記エンドエフェクタ、およびこのエンドエフェクタ等に搭載するワークを含む搭載重量である。
 図2の操作装置Ouは、表示部62の例えばタッチパネルから成るボタン63または物理的なボタン64等の操作手段61により、図1の制御装置Cuへの指令が可能な他、制御装置Cu内の制御パラメータを表示部62(図2)に表示すること、および制御装置Cu内の制御パラメータを書き込み・更新することが可能である。なお外部指令手段Edは、操作装置Cuに設けられてもよい。前記制御パラメータを、単に、パラメータまたはパラメータ値という場合がある。
 図2に示すように、操作装置Ouは、負荷条件を1~n(n:2以上の自然数)に切り替えるボタン63aと、先端部材40(図3)の加加速度・加速度に関わる後述の制御パラメータA~mである複数の制御パラメータを表示・数値入力できるパラメータ表示・数値入力部63bと、複数の制御パラメータを制御装置Cu(図1)に書き込むパラメータ書込ボタン63cとを有する。
 複数の制御パラメータA~mは、図8のように、負荷条件1~nと連動している。負荷条件を切り替えると、図2の操作装置Ouの表示部62に表示される制御パラメータA~mの数値も切り替わり、また図1に示す制御装置Cuの初期パラメータ生成規則部65(後述する)にもパラメータ切替指令が送信される。
 姿勢変更制御手段58は、各姿勢制御用アクチュエータ10を、現在姿勢であるときの基端側の端部リンク部材15の各回転角から、目標姿勢となるときの基端側の端部リンク部材15の各回転角までの指令アーム回転角度だけ駆動する手段である。姿勢変更制御手段58は、具体的には、初期パラメータ生成規則部65、指令変換部60、同期制御部66および個別制御部59を備える。
 初期パラメータ生成規則部65は、パラメータ記憶部65aとパラメータ切替手段65bとを有する。パラメータ記憶部65aは、負荷条件毎の加加速度・加速度に関わる複数のパラメータ値を記憶しており、そのパラメータ値は操作装置Ouまたは外部指令手段Edから更新することが可能である。パラメータ記憶部65aのパラメータは、操作装置Ouまたは外部指令手段Edに表示されず、また操作装置Ouまたは外部指令手段Edから更新できない書き込み不可のパラメータを有していてもよい。
 <パラメータ切替手段>
 パラメータ切替手段65bは、先端部材40に作用する負荷に応じて、姿勢制御用アクチュエータ10または先端部材40の加加速度および加速度を調整するように制御パラメータを切り替える。具体的には、パラメータ切替手段65bは、操作装置Ouまたは外部指令手段Edから指令された負荷条件1~nに対応したパラメータをパラメータ記憶部65aから呼び出し、指令変換部60の初期パラメータ生成部60aの規則として送信する。
 また、パラメータ切替手段65bは、移動平均フィルタのフィルタ時定数およびモデル追従ゲインの少なくともいずれか1つを含む複数の制御パラメータを切り替える。初期パラメータ生成部60aでは、定められた規則に沿って、制御パラメータを生成する。
 加加速度・加速度に関わる制御パラメータA~mの例として、加速時間、減速時間、指令速度における最大速度、フィルタ時定数、慣性モーメント比、位置ループゲイン、速度ループゲイン、速度ループ積分時定数等があるが、この例に限定されるものではない。
 <フィルタ時定数を設定しなかった場合の速度波形等>
 図9Aに、フィルタ時定数を設定しなかった場合の速度波形・加速度波形を参考に示す。制御パラメータとしてフィルタ時定数を設定しない場合、指令速度Vまでの加速時と姿勢制御完了時の減速時に、加速度の急激な変化が生じる(すなわち加加速度が大きい)。そのため、負荷である搭載重量が大きいと、動作時、整定時の振動が大きくなる。パラレルリンク機構の位置決め時等の加速または減速時において、パラレルリンク機構の停止状態から等速運動になるまでの加速領域、またはその反対にパラレルリンク機構の等速運動から停止状態になるまでの減速領域を、「整定時」という。
 <フィルタ時定数を設定した場合の速度波形等>
 図9Bは、本実施形態でありフィルタ時定数を設定した場合の速度波形・加速度波形を示している。加加速度・加速度に関わる制御パラメータとして、フィルタ時定数tdを設けることで、加速時と減速時の加加速度を小さくしている。但し、フィルタ時定数tdを設けるだけでは、指令速度Vまでの加速、または速度ゼロまでの減速に必要な時間が長くなり、高速動作ができない。
 そこで図9Bの加速時間ta´・減速時間tc´を、図9Aの加速時間ta・減速時間tcよりも短くするか、または図9Bの最大加速度A´を図9Aの最大加速度Aよりも大きくするか、または図示していないが指令速度Vを大きくするか、それらの内のいずれか一つまたは複数を組み合わせて行う。これにより、動作時・整定時の振動を小さくしながら高速動作を実現する。
 <フィルタ時定数を設定しなかった場合の制御方法>
 図10Aの参考例に示すように、通常、目標位置への移動指令を行うと、リンク作動装置の姿勢変更制御手段58Aは、先端側のリンクハブ13(図3)の現在位置での位置、姿勢を認識すると共に、指令された目標位置での位置、姿勢を演算する。これらの演算後、姿勢変更制御手段58Aは、目標位置までの距離、指令速度、加速時間および減速時間から、制御装置に接続されたサーボモータMである姿勢制御用アクチュエータ10(図3)の実際の移動量および移動速度を演算し、速度指令および位置指令として前記サーボモータMへ出力する。
 前記姿勢変更制御手段58Aは、出力された指令情報と、サーボモータMのエンコーダEから現在位置のフィードバック情報、および現在の移動速度のフィードバック情報を加えながら、位置制御部59a、速度制御部67および電流制御部68でそれぞれ、比例ゲイン、積分ゲインおよび微分ゲインを調整する。電流制御部68の後段に電力変換部69が設けられこの電力変換部69にて所定の交流電力に変換される。
 <フィルタ時定数を設定した場合の制御方法>
 図10Bに示す本実施形態のように、速度指令の要素にフィルタ時定数tdを追加すると、通常の速度指令および位置指令だけでは、位置制御部59aまたは速度制御部67での比例ゲイン、積分ゲイン、微分ゲインの調整では収束できなくなる。そのため、フィルタ時定数tdの影響を各制御部に与えるための要素を追加する必要がある。この追加の制御要素の調整、指令を行う制御部をモデル追従制御部70と呼ぶ。例えば、モデル追従制御部70は、位置制御部59aにモデル追従制御ゲイン、速度制御部67には速度フィードフォワード、電流制御部68にはトルクフィードフォワードをそれぞれ加えることで、サーボモータEの応答性を向上させることができる。
 <指令変換部等>
 図1に示すように、指令変換部60は、外部指令手段Edから前記ポイント演算手段を介して、または直接に折れ角θと旋回角φとで与えられる目標姿勢の指令B(θb,φb)を、各リンク機構14の基端側の端部リンク部材15の回転角βに変換することを基本の機能とする手段であり、その変換された各基端側の端部リンク部材15の回転角βn(β1~β3)と、現在の各回転角αとの差が、指令アーム回転角度となる。折れ角θと旋回角φから各リンク機構14の基端側の端部リンク部材15の回転角βを求める演算は、定められた関係式(1)による逆変換で行われる。
Figure JPOXMLDOC01-appb-M000001
 式(1)において、γは、基端側の端部リンク部材15に回転自在に連結された中央リンク部材17の連結端軸と、先端側の端部リンク部材15に回転自在に連結された中央リンク部材17とが成す角度である。δn(δ1,δ2,δ3)は、基準となる基端側の端部リンク部材15に対する各基端側の端部リンク部材15の円周方向の離間角である。リンク機構14の数が3組で、各リンク機構14が円周方向に等配である場合、各基端側の端部リンク部材15の円周方向の離間角δ1,δ2,δ3は、それぞれ0°,120°,240°となる。
 前記関係式(1)より、先端側のリンクハブ13のある姿勢A(θa、φa)と姿勢B(θb、φb)について、姿勢A、Bに対応するアーム回転角は、それぞれ姿勢Aのアーム回転角(β1a、β2a、β3a)、姿勢Bのアーム回転角(β1b、β2b、β3b)として関係が成り立つ。
 指令変換部60は、前記基本の機能を有する手段に加えて、初期パラメータ生成部60aおよび判断・変更部60bを有する。指令変換部60で変換して得られた指令アーム回転角度は、同期制御部66を介して、各姿勢制御用アクチュエータ10に対応する各個別制御部59に与えられる。つまり指令変換部60内で初期パラメータ生成、所定の判断・変更をして、各ポイント間の速度および各姿勢制御用アクチュエータ(モータ位置)座標を予め計算する。
 同期制御部66は、各基端側の端部リンク部材15の回転の同期制御を行わせる手段であり、同期タイミングに合わせてアクチュエータドライバである個別制御部59へ毎時毎の位置指令を送信する。個別制御部59では同期制御部66の指令に応じて対応する姿勢制御用アクチュエータ10を駆動する。同期制御部66は、各個別制御部59へ指定するパラメータおよび位置をそれぞれ設定するパラメータ設定部66aおよび位置設定部66bを有し、パラメータ設定部66aには、指令変換部60により初期に生成された制御パラメータを、変更したときはその変更した制御パラメータを設定する。位置設定部66bにおいては指令アーム回転角度を設定する。
 各個別制御部59は、対応する姿勢制御用アクチュエータ10の動作を、各基端側の端部リンク部材15の現在角度から目標角度へ回転させるように制御する手段であり、サーボドライバからなる位置制御部59aおよび指令実行手段59bを有する。同期制御部66より各制御パラメータおよびアーム指令回転角度に従い、パルス払い出し等によって位置制御部59aへ動作指令を与え、指令実行手段59bで姿勢制御用アクチュエータ10を駆動する。位置制御部59aは、その与えられた動作指令と、回転角検出手段であるエンコーダE(図10B)の検出値を用いてフィードバック制御を行う。
 指令変換部60の初期パラメータ生成部60aは、上位から与えられた各基端側の端部リンク部材15の指令アーム回転角度だけ、各基端側の端部リンク部材15が同時に回転を始めて同時に回転が止まるように制御する制御パラメータを、定められた規則に従って制御パラメータの初期値として生成する。
 初期パラメータ生成部60aは、制御パラメータのうち、加速時間と減速時間を、リンク作動装置7の共振周波数の1周期に設定する。ここで言う共振周波数は、先端側のリンクハブ13にエンドエフェクタ等の、搭載された全ての搭載物を設置した状態での共振周波数のことである。
 判断・変更部60bは、初期パラメータ生成部60aで生成された制御パラメータを、定められた基準で判断し、変更すべきと判断した場合に変更する手段である。判断・変更部60bは、動作時間推定手段60ba、条件選定手段60bb、およびパラメータ変更手段60bcを有する。動作時間推定手段60baは、姿勢制御用アクチュエータ10の加速時間、減速時間、指令速度、および指令アーム回転角度から動作時間を推定する。条件選定手段60bbは、この推定された推定動作時間と、加速時間および減速時間の合計とを比較する手段である。パラメータ変更手段60bcは、条件選定手段60bbによる比較の結果により、前記制御パラメータの初期値を変更する。
 <作用効果>
 以上説明したリンク作動装置7の制御装置Cuによると、例えば、搭載重量等の負荷の増加時に加加速度を小さくすることで、先端部材40の動作中および整定時の振動を小さくすることができる。したがって、指令速度を低下させることなく加加速度を調整するため、高速動作を実現しながら、1つの機械体で幅広い搭載重量に対応することができるようになる。これにより産業機器であるリンク作動装置7の汎用性を高めることができる。
 リンク作動装置7は、パラレルリンク機構9を採用しており、可動部にサーボモータを配置する必要がなく、可動部が軽量のため、加加速度を大きくして、細かい動作を高速で行うことが得意である。このようなリンク作動装置7では、加加速度が速度つまりタクトタイムに大きく影響し、搭載重量を増加させると可動部が重たくなって振動が発生しやすくなるため、加加速度を調整するように制御パラメータを切り替えるパラメータ切替手段65bがより有効になる。
 パラメータ切替手段65bは、移動平均フィルタのフィルタ時定数およびモデル追従制御ゲインの少なくともいずれか1つを含む複数の制御パラメータを切り替える。この場合、移動平均フィルタのフィルタ時定数を大きくする、または、モデル追従制御ゲインを小さくすることで、加加速度を小さくできるため、加速度の変化により発生する衝撃が小さくなる。そのため、搭載重量(負荷)が大きい場合に、移動平均フィルタのフィルタ時定数を大きくする、または、モデル追従制御ゲインを小さくするように、パラメータ切替手段65bでこれらの制御パラメータを変更する。これにより、パラレルリンク機構9の速度を低下させることなく、整定時の振動およびアクチュエータ10のトルクを低減でき、整定時および動作中の先端部材40の振動を小さくできる。
 また、通常の制御では、移動平均フィルタによる加速度の連続的な変化を考慮していないため、この加速度の連続的な変化を外乱による影響とみなし、自動制御ループを自動で調整するため、意図した結果が得られないことがある。このような場合には、移動平均フィルタのフィルタ時定数だけでなく、モデル追従制御ゲインと合わせて調整すれば、通常時の指令のような直線形を理想形として、位置制御、速度制御、電流制御を負荷の大きさに応じた理想形に近づくように制御できるようになる。これにより、振動・衝撃の発生を抑制し、整定時間の減少および最大速度の維持を実現することができる。
 パラメータ切替手段65bは、姿勢制御用アクチュエータ10または先端部材40の加速度を調整する複数の制御パラメータを切り替える。この場合、搭載重量に応じて、加加速度だけでなく、加速度を調整することで、制御パラメータの調整幅が広がり、リンク作動装置7の速度を低下させることなく、整定時および動作中の振動および姿勢制御用アクチュエータ10のトルクを低減できる。
 前記加速度を調整する複数の制御パラメータは、加速時間、減速時間および指令速度のうち、少なくともいずれか1つを含む。加速度に関わる制御パラメータを、加速時間、減速時間および指令速度のうち、少なくともいずれか1つを含むようにすれば、加速度を簡単に調整することができる。
 パラメータ切替手段65bは、負荷が大きい程、加加速度を小さくし、加速度を大きくしてもよい。リンク作動装置7の先端部材40に与える衝撃は、加速度よりも加加速度の影響が大きいため、このように制御パラメータを調整することで、より高速にリンク作動装置7を動作させることが可能になる。
 リンク作動装置7は、先端部材40の動作パターンおよび制御パラメータを設定する操作装置Ouを備え、図2の操作装置Ouは、負荷条件を選択および変更する操作手段61を有する。この場合、操作装置Ouの操作手段61により、図1の制御装置Cuの動作パターンおよび制御パラメータ等を設定するだけでなく、負荷条件に合わせて、制御パラメータを、負荷条件に応じた値に簡単に切り替えることができるようになる。
 <他の実施形態について>
 次に、他の実施形態について説明する。以下の説明においては、各実施形態で先行して説明している事項に対応している部分には同一の参照符号を付し、重複する説明を略する。構成の一部のみを説明している場合、構成の他の部分は、特に記載のない限り先行して説明している実施形態と同様とする。同一の構成は同一の作用効果を奏する。各実施形態で具体的に説明している部分の組合せばかりではなく、特に組合せに支障が生じなければ、実施形態同士を部分的に組合せることも可能である。
 [第2の実施形態:図11]
 図11に示すように、基端側のアーム長L1が先端側のアーム長L2よりも長いパラレルリンク機構9であってもよい。基端側のアーム長L1は、基端側の端部リンク部材15と基端側のリンクハブ12との回転対偶軸の軸方向の中心点Paと、基端側の球面リンク中心PAとの距離である。前記先端側のアーム長L2は、先端側の端部リンク部材16と先端側のリンクハブ13との回転対偶軸の軸方向の中心点Pbと、先端側の球面リンク中心PBとの距離である。このパラレルリンク機構9を有するリンク作動装置においても、前記と同様の制御装置Cuを備えることで、幅広い搭載重量に対応でき汎用性を高めることができる。
 [第3の実施形態:図12]
 図12に示すように、制御装置Cuは、3つの回転体71を姿勢制御用アクチュエータ10により回転させることにより、基端側のリンクハブ12に対し先端側のリンクハブ13の姿勢を制御してもよい。3つの回転体71は同軸でそれぞれ回転自在に支持された状態で基端側のリンクハブ12に支持されている。姿勢制御用アクチュエータ10の回転軸にプーリ72がそれぞれ支持され、3つのプーリ72のそれぞれと各回転体71との間にベルト73が掛け渡されている。これにより、姿勢制御用アクチュエータ10の回転軸を回転させることでプーリ72が回転し、ベルト73を介して回転体71を回転させることで、先端側のリンクハブ13の姿勢を制御し得る。このパラレルリンク機構9を有するリンク作動装置においても、前記と同様の制御装置Cuを備えることで、幅広い搭載重量に対応でき汎用性を高めることができる。
 [第4の実施形態:工作機械]
 産業機器として、例えば図13Aに示す工作機械74Aを適用してもよい。この工作機械74Aは、門型の架台75に直交2軸(X,Z軸)方向に進退する直動ユニット76と、この直動ユニット76の下方で前記XおよびZ軸方向にそれぞれ直交するY軸方向に搬送可能な搬送機構77とを備えている。直動ユニット76の出力部となる移動駆動用のアクチュエータ10に、ワークWを機械加工可能なツールTLが取り付けられ、搬送機構77の搬送台に、ワークWが取り付けられている。前記アクチュエータ10および搬送機構77は、制御装置Cuにより同期制御される。前記アクチュエータ10等を制御する制御装置Cuとして、前記と同様の制御装置を適用することで、幅広い搭載重量に対応でき汎用性を高めた工作機械を実現し得る。
 [第5の実施形態:工作機械]
 産業機器として、図13Bに示す工作機械74Bを適用してもよい。この工作機械74Bでは、前述の搬送機構に代えて、ワークWを例えばX軸回りに回転自在に支持する回転駆動機構78が設置されている。この場合にも前記アクチュエータ10等を制御する制御装置Cuとして、前記と同様の制御装置を適用することで、幅広い搭載重量に対応でき汎用性を高めた工作機械を実現し得る。
 リンク作動装置としてパラレルリンク型構造の装置にて図示したが、折れ角θ、旋回角φを制御できる構成であればよいため、作動機構としてパン・チルト構成(図示せず)を適用してもよい。
 図示しないが、産業機器として、垂直多関節ロボットまたは水平多関節ロボットを適用してもよい。
 以上のとおり、図面を参照しながら好適な実施形態を説明したが、本発明の趣旨を逸脱しない範囲内で、種々の追加、変更、削除が可能である。したがって、そのようなものも本発明の範囲内に含まれる。
 7…リンク作動装置(産業機器)
 10…姿勢制御用アクチュエータ
 12…基端側のリンクハブ
 13…先端側のリンクハブ
 14…リンク機構
 15…基端側の端部リンク部材
 16…先端側の端部リンク部材
 17…中央リンク部材
 40…先端部材
 61…操作手段
 65b…パラメータ切替手段
 74A,74B…工作機械(産業機器)
 Cu…制御装置
 Ou…操作装置

Claims (7)

  1.  アクチュエータにより先端部材が移動可能に設けられた産業機器における、前記アクチュエータを制御する産業機器の制御装置であって、
     前記先端部材に作用する負荷に応じて、前記アクチュエータまたは前記先端部材の加加速度を調整するように制御パラメータを切り替えるパラメータ切替手段を備えた、産業機器の制御装置。
  2.  請求項1に記載の産業機器の制御装置において、前記産業機器はリンク作動装置であり、このリンク作動装置は、基端側のリンクハブに対し先端側のリンクハブが3組以上のリンク機構を介して姿勢を変更可能に連結され、前記各リンク機構が、それぞれ前記基端側のリンクハブおよび前記先端側のリンクハブに一端が回転可能に連結された基端側および先端側の端部リンク部材と、これら基端側および先端側の端部リンク部材の他端に両端がそれぞれ回転可能に連結された中央リンク部材とを有し、前記3組以上のリンク機構のうちの2組以上のリンク機構に、前記基端側のリンクハブに対する前記先端側のリンクハブの姿勢を任意に変更させる姿勢制御用の前記アクチュエータが設けられている産業機器の制御装置。
  3.  請求項1または請求項2に記載の産業機器の制御装置において、前記パラメータ切替手段は、移動平均フィルタのフィルタ時定数およびモデル追従制御ゲインの少なくともいずれか1つを含む複数の制御パラメータを切り替える産業機器の制御装置。
  4.  請求項1ないし請求項3のいずれか1項に記載の産業機器の制御装置において、前記パラメータ切替手段は、前記アクチュエータまたは前記先端部材の加速度を調整する複数の制御パラメータを切り替える産業機器の制御装置。
  5.  請求項4に記載の産業機器の制御装置において、前記加速度を調整する複数の制御パラメータは、加速時間、減速時間および指令速度のうち、少なくともいずれか1つを含む産業機器の制御装置。
  6.  請求項4または請求項5に記載の産業機器の制御装置において、前記パラメータ切替手段は、前記負荷が大きい程、前記加加速度を小さくし、前記加速度を大きくする産業機器の制御装置。
  7.  請求項1ないし請求項6のいずれか1項に記載の産業機器の制御装置において、前記産業機器は、少なくとも前記先端部材の動作パターンおよび前記制御パラメータを設定する操作装置を備え、この操作装置は、負荷条件を選択および変更する操作手段を有する産業機器の制御装置。
PCT/JP2023/011499 2022-03-29 2023-03-23 産業機器の制御装置 WO2023190030A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2022053430A JP2023146304A (ja) 2022-03-29 2022-03-29 産業機器の制御装置
JP2022-053430 2022-03-29

Publications (1)

Publication Number Publication Date
WO2023190030A1 true WO2023190030A1 (ja) 2023-10-05

Family

ID=88202051

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2023/011499 WO2023190030A1 (ja) 2022-03-29 2023-03-23 産業機器の制御装置

Country Status (2)

Country Link
JP (1) JP2023146304A (ja)
WO (1) WO2023190030A1 (ja)

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013198942A (ja) * 2012-03-23 2013-10-03 Ntn Corp リンク作動装置の制御方法およびその制御装置
KR20130116766A (ko) * 2012-04-16 2013-10-24 현대위아 주식회사 Cnc 공작기계장치 및 그 제어장치
JP2015055895A (ja) * 2013-09-10 2015-03-23 Ntn株式会社 リンク作動装置の制御装置
JP2015188945A (ja) * 2014-03-27 2015-11-02 Ntn株式会社 塗布装置
WO2018029910A1 (ja) * 2016-08-08 2018-02-15 三菱電機株式会社 パラレルリンク機構の制御装置
JP2018157046A (ja) * 2017-03-17 2018-10-04 ファスフォードテクノロジ株式会社 ダイボンディング装置および半導体装置の製造方法
JP2018163585A (ja) * 2017-03-27 2018-10-18 ファナック株式会社 工作機械の制御システム
JP2019082771A (ja) * 2017-10-30 2019-05-30 ブラザー工業株式会社 数値制御装置と制御方法
JP2019109598A (ja) * 2017-12-15 2019-07-04 オムロン株式会社 制御システム
JP2021024061A (ja) * 2019-08-08 2021-02-22 Ntn株式会社 リンク作動装置
JP2021163077A (ja) * 2020-03-31 2021-10-11 ブラザー工業株式会社 数値制御装置及び数値制御方法

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013198942A (ja) * 2012-03-23 2013-10-03 Ntn Corp リンク作動装置の制御方法およびその制御装置
KR20130116766A (ko) * 2012-04-16 2013-10-24 현대위아 주식회사 Cnc 공작기계장치 및 그 제어장치
JP2015055895A (ja) * 2013-09-10 2015-03-23 Ntn株式会社 リンク作動装置の制御装置
JP2015188945A (ja) * 2014-03-27 2015-11-02 Ntn株式会社 塗布装置
WO2018029910A1 (ja) * 2016-08-08 2018-02-15 三菱電機株式会社 パラレルリンク機構の制御装置
JP2018157046A (ja) * 2017-03-17 2018-10-04 ファスフォードテクノロジ株式会社 ダイボンディング装置および半導体装置の製造方法
JP2018163585A (ja) * 2017-03-27 2018-10-18 ファナック株式会社 工作機械の制御システム
JP2019082771A (ja) * 2017-10-30 2019-05-30 ブラザー工業株式会社 数値制御装置と制御方法
JP2019109598A (ja) * 2017-12-15 2019-07-04 オムロン株式会社 制御システム
JP2021024061A (ja) * 2019-08-08 2021-02-22 Ntn株式会社 リンク作動装置
JP2021163077A (ja) * 2020-03-31 2021-10-11 ブラザー工業株式会社 数値制御装置及び数値制御方法

Also Published As

Publication number Publication date
JP2023146304A (ja) 2023-10-12

Similar Documents

Publication Publication Date Title
CA3020920C (en) Variable stiffness series elastic actuator
US20160361816A1 (en) Device and method for controlling link actuation device
JP6602620B2 (ja) 組合せ型リンク作動装置
WO2017043420A1 (ja) リンク作動装置を用いた複合作業装置
US20200384642A1 (en) Working device using parallel link mechanism and control method thereof
JP6576646B2 (ja) リンク作動装置を用いた多関節ロボット
JP2019198960A (ja) リンク作動装置を用いた多関節ロボット
Shut et al. Development of a humanoid dual arm system for a single spherical wheeled balancing mobile robot
WO2023190030A1 (ja) 産業機器の制御装置
WO2016084685A1 (ja) パラレルリンク機構を用いた作業装置
CN114269520B (zh) 具有多功能刀具定向的并联运动装备
US20220226992A1 (en) Manipulator for finishing work, and control method therefor
JP2020506815A (ja) ロボット
Hafez et al. Stable under-actuated manipulator design for mobile manipulating Unmanned Aerial Vehicle (MM-UAV)
JP6517292B2 (ja) リンク作動装置の制御装置
JPH08161015A (ja) 多関節型ロボットの駆動制御方法
JP6215623B2 (ja) リンク作動装置の制御装置
WO2023054057A1 (ja) パラレルリンク機構およびリンク作動装置
US11420324B2 (en) Parallel link robot
WO2022107652A1 (ja) 作業装置
WO2024048561A1 (ja) リンク作動装置の制御装置
US20210283772A1 (en) Control device for link operation device
WO2019189198A1 (ja) リンク作動装置を用いた複合作業装置
JP2023015848A (ja) ロボットコントローラ及びロボットの緊急停止方法
Birkenhofer et al. Hierarchical control architecture for a multi-segmented inspection robot

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

Country of ref document: EP

Kind code of ref document: A1