WO2019215980A1 - ロボット制御装置 - Google Patents

ロボット制御装置 Download PDF

Info

Publication number
WO2019215980A1
WO2019215980A1 PCT/JP2019/005302 JP2019005302W WO2019215980A1 WO 2019215980 A1 WO2019215980 A1 WO 2019215980A1 JP 2019005302 W JP2019005302 W JP 2019005302W WO 2019215980 A1 WO2019215980 A1 WO 2019215980A1
Authority
WO
WIPO (PCT)
Prior art keywords
acceleration
torque
time
joint
axis
Prior art date
Legal status (The legal status 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 status listed.)
Ceased
Application number
PCT/JP2019/005302
Other languages
English (en)
French (fr)
Inventor
敦実 橋本
中田　広之
正義 岩谷
良祐 山本
紘義 上田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Panasonic Intellectual Property Management Co Ltd
Original Assignee
Panasonic Intellectual Property Management Co Ltd
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 Panasonic Intellectual Property Management Co Ltd filed Critical Panasonic Intellectual Property Management Co Ltd
Priority to JP2020518145A priority Critical patent/JP7126222B2/ja
Publication of WO2019215980A1 publication Critical patent/WO2019215980A1/ja
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Program-control systems
    • G05B19/02—Program-control systems electric
    • G05B19/18—Numerical 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 program data in numerical form
    • G05B19/416—Numerical 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 program data in numerical form characterised by control of velocity, acceleration or deceleration

Definitions

  • the present invention relates to a robot control apparatus related to robot operation control.
  • Patent Document 1 the maximum or minimum acceleration of the reference joint axis is corrected so that the torque obtained using the dynamic model becomes the target torque while keeping the maximum or minimum acceleration arrival time of each joint axis constant. Techniques to do this are disclosed. By doing in this way, vibration of the robot arm at the time of acceleration / deceleration can be suppressed, and a smooth acceleration / deceleration operation can be performed.
  • the torque generated in the joint shaft depends on the output torque of the motor connected to the joint shaft, and is limited by the allowable maximum torque of the motor. That is, when a plurality of joint axes are operated simultaneously, the torque required to operate the joint axes may be insufficient.
  • the joint axis is rotated with insufficient torque during acceleration, only the joint axis will be delayed, and the trajectory of the arm tip may follow an unexpected trajectory. That is, the robot may come into contact with surrounding objects.
  • the torque required for deceleration is insufficient, an overshoot may occur at the target teaching point. Even in this case, there is a risk of contact with surrounding objects.
  • the robot arm operation program is corrected. Specifically, it responds by adding a command for adjusting the acceleration / deceleration time or changing the target operation speed.
  • the maximum or minimum reference joint axis is set so that the torque obtained using the dynamic model becomes the target torque while keeping the maximum or minimum acceleration arrival time of each joint axis constant. The minimum acceleration has been corrected.
  • the present invention has been made in view of such points, and the acceleration / deceleration time is set so that the torque required to operate the joint shaft does not exceed the allowable maximum torque of the motor while suppressing an increase in the tact time of the robot. It is to provide a robot control device having a mechanism for automatically adjusting the angle.
  • a robot control apparatus is a robot control apparatus that controls the operation of a robot arm having a plurality of sets of motors and joint axes that are rotationally driven by the motors.
  • a dynamic torque calculating unit that calculates and outputs the dynamic torque in each joint axis, and each joint at the time when the rotational acceleration of each joint axis becomes maximum and minimum
  • a storage unit having at least a table in which the movement amount and rotation speed of the joint angle on the shaft and the maximum and minimum values of the rotation acceleration are associated with acceleration / deceleration time for accelerating / decelerating each joint axis;
  • the dynamic torque calculation unit calculates dynamic torque corresponding to the maximum value and the minimum value of the rotational acceleration based on the values in the table, and An inertial term torque corresponding to the maximum and minimum values of the rolling acceleration and a residual torque obtained by subtracting the inertial term torque from the dynamic torque are calculated, and at least one of the
  • the acceleration / deceleration time is automatically adjusted so that the torque required for each joint axis when operating the robot arm does not exceed the outputable torque. Therefore, the trouble of correcting the teaching of the robot operation program can be saved. Further, an increase in the tact time of the robot can be suppressed.
  • FIG. 1 is a functional block diagram of a robot control apparatus according to an embodiment of the present invention.
  • FIG. 2 is a diagram illustrating temporal changes in joint angles, speeds, and accelerations at different joint axes.
  • FIG. 3 is a schematic diagram showing the configuration of the two-axis robot.
  • FIG. 4 is a diagram showing temporal changes in speed, acceleration, and dynamic torque during acceleration on the j-axis.
  • FIG. 5 is a flowchart showing a procedure for correcting the acceleration / deceleration time according to the embodiment of the present invention.
  • FIG. 6A is a diagram showing temporal changes in acceleration, speed, and angular movement when the acceleration / deceleration time is 100 msec.
  • FIG. 6B is a diagram showing temporal changes in acceleration, speed, and angular movement when the acceleration / deceleration time is 150 msec.
  • FIG. 6C is a diagram illustrating temporal changes in acceleration, speed, and angular movement when the acceleration / deceleration time is 200 msec.
  • FIG. 7 is a diagram showing the configuration of the table.
  • FIG. 8 is a block diagram for deriving the amount of angular movement, speed, and acceleration.
  • FIG. 9 is a diagram illustrating temporal changes in joint angle, speed, acceleration, and dynamic torque during acceleration / deceleration on the j-axis.
  • FIG. 1 shows a functional block configuration of a robot control apparatus according to the present embodiment
  • FIG. 2 shows temporal changes in velocity and acceleration on different i-axis and j-axis
  • FIG. 3 shows a biaxial robot.
  • the schematic diagram of is shown.
  • subscripts i and j are integers, 1 ⁇ i, j ⁇ n, and i ⁇ j
  • n is the number of joint axes included in the robot arm 6.
  • the rotational speed or rotational acceleration of the i-axis or j-axis that is the rotational axis may be simply referred to as the i-axis or j-axis speed or acceleration.
  • the robot controller 10 includes an operation program 1, a processing unit 2, a movement command generation unit 3, an acceleration / deceleration processing unit 4, a servo 5, a movement time calculation unit 7, each axis speed calculation unit 8, A deceleration time calculation unit 9, a recording unit 20, a dynamic torque calculation unit 21, a correction processing unit 22, and a calculation unit 23 are provided as functional blocks.
  • the function block shown in FIG. 1 executes software stored in the recording unit 20 or read from the outside on an arithmetic device such as a CPU (Central Processing Unit) (not shown) provided in the robot control device 10. This is realized.
  • the operation program 1 may be included in this software. Further, for convenience of explanation, illustration of a plurality of sets including a joint axis incorporated in the robot arm 6 and a motor connected to the joint axis and rotating the joint axis is omitted.
  • the teaching point position of the robot arm 6, the interpolation form corresponding to the shape of the locus connecting the teaching points, and the target moving speed are recorded.
  • the teaching point position is a work point position in the orthogonal space or a joint angle of the robot arm 6.
  • the target moving speed is a target speed when moving between teaching points in the instructed interpolation form.
  • PTP interpolation is an interpolation mode applied when moving between teaching points in the shortest time. In many cases, one or a plurality of joint axes of the robot arm 6 is operated so as to rotate at the maximum speed.
  • the processing unit 2 converts the teaching point position into a joint angle of each joint axis of the robot arm 6, and the teaching point position is determined by the robot. In the case of the joint angle of the arm 6, it is converted into a value on the orthogonal space.
  • an arbitrary teaching point recorded on the operation program 1 is Pa, and the next teaching point is Pb.
  • the movement command generation unit 3 generates and outputs a movement command based on the movement amount between adjacent teaching points and the target movement speed.
  • This movement command is a joint angle movement amount per unit time (hereinafter, simply referred to as an angle movement amount).
  • the amount of angular movement of each joint is collectively set as one set, and this is set as one movement command. Therefore, the movement command is a vector quantity.
  • the movement command generation unit 3 outputs a plurality of sets of movement commands corresponding to the movement time described later in time series. A plurality of sets of movement commands output in time series is called a movement command sequence.
  • the movement command sequence output by the movement command generation unit 3 is not subjected to acceleration / deceleration processing described later.
  • the acceleration / deceleration processing unit 4 performs an acceleration / deceleration process on the movement command sequence from the movement command generation unit 3 and outputs an accelerated / decelerated movement command.
  • the acceleration / deceleration processing unit 4 performs acceleration / deceleration processing on the movement command sequence from the movement command generation unit 3 so that the target movement speed is reached in an acceleration time output by an acceleration / deceleration time calculation unit 9 described later. Specifically, as shown in FIG. 2, the acceleration at each joint axis is changed with time so as to reach a predetermined target moving speed.
  • the movement command sequence from the movement command generation unit 3 is set so that the deceleration starts from the target movement speed before the teaching point Pb and reaches the teaching point Pb after the deceleration time output by the acceleration / deceleration time calculation unit 9 has elapsed. Decelerate.
  • the time-varying waveform of acceleration may be referred to as an acceleration profile, a deceleration profile, or an acceleration / deceleration profile.
  • the acceleration / deceleration profile has a shape in which the speed changes in an S shape with respect to time so as not to induce vibration of the robot arm 6.
  • the acceleration / deceleration processing is performed based on the corrected acceleration time or deceleration time output from the calculation unit 23 described later, and a specific acceleration / deceleration processing procedure will be described later.
  • the servo 5 controls the operation of the robot arm 6 by rotationally driving the motor connected to each joint axis based on the movement command sequence processed by the acceleration / deceleration processing unit 4.
  • the movement time calculation unit 7 calculates and outputs the time required for the tip of the robot arm 6 to move at the target movement speed without acceleration / deceleration from the teaching point Pa to the teaching point Pb.
  • the required time corresponds to the travel time.
  • Each axis speed calculation unit 8 calculates and outputs a target speed of each joint axis at the time of PTP interpolation.
  • the acceleration / deceleration time calculation unit 9 obtains and outputs an acceleration time when accelerating from the teaching point Pa to the target speed and a deceleration time when decelerating from the target speed and reaching the teaching point Pb before the teaching point Pb.
  • the storage unit 20 stores a later-described table 24 (see FIG. 7) and the operation program 1, and transmits the stored data to the corresponding block in accordance with requests from each unit of the robot control apparatus 10.
  • the dynamic torque calculation unit 21 calculates and outputs the dynamic torque of each joint axis at a predetermined time based on the data in the table 24.
  • the correction processing unit 22 uses first and second correction coefficients ⁇ a, which will be described later, based on the dynamic torque, the inertia term torque, and the torque other than the inertia term torque at the predetermined time calculated by the dynamic torque calculation unit 21. ⁇ b is calculated and output.
  • the calculation unit 23 multiplies the acceleration time Ta or the deceleration time Tb calculated by the acceleration / deceleration time calculation unit 9 by the first or second correction coefficient ⁇ a, ⁇ b calculated by the correction processing unit 22, and after correction. Acceleration time Ta ′ or deceleration time Tb ′ is obtained and output to the acceleration / deceleration processing unit 4.
  • the table 24 is a table in which the actual acceleration that is the maximum or the minimum when each joint axis of the robot arm 6 is driven and the speed and the amount of angular movement at that time are arranged in association with the acceleration / deceleration time.
  • the acceleration time is, for example, the time from the acceleration at the teaching point Pa until reaching the target movement speed
  • the deceleration time is, for example, the time from the start of deceleration before the teaching point Pb until the movement speed becomes zero.
  • Time is referred to as acceleration / deceleration time.
  • the acceleration time when accelerating to the target speed with the maximum allowable acceleration of each joint axis (sometimes called the shortest acceleration time of each axis) is obtained, Select the one with the largest value and set this as the acceleration time common to all axes. As shown in FIG. 2, all joint axes are accelerated with an acceleration time common to all the axes.
  • the shortest deceleration time for each joint axis is selected with the maximum value, and this is set as the deceleration time common to all axes. Similar to the acceleration, all the joint axes decelerate with the deceleration time common to all the axes (see FIG. 2).
  • the acceleration / deceleration time in the table 24 is an acceleration / deceleration time common to all axes.
  • the configuration and creation procedure of the table 24 will be described later.
  • FIG. 4 shows temporal changes in speed, acceleration, and dynamic torque during acceleration on the j-axis.
  • FIG. 4 shows acceleration and torque calculated based on the movement command output from the movement command generation unit 3 corresponding to the j-axis speed.
  • the solid line indicates the dynamic torque calculated based on the movement command, and the broken line indicates the dynamic torque actually applied to the j-axis.
  • the dynamic torque increases as the acceleration increases, reaches a maximum value at time t2, and then decreases as the acceleration decreases.
  • the maximum torque that can be output by the j-axis is the allowable maximum torque ⁇ jmax related to the j-axis
  • the dynamic torque calculated based on the movement command exceeds the allowable maximum torque ⁇ jmax in the period from time t1 to time t3. Yes. This means that the torque for driving the joint shaft is insufficient. In such a case, for example, it is necessary to perform adjustment to increase the acceleration time so that the dynamic torque becomes equal to or less than the allowable maximum torque ⁇ jmax.
  • the actual speed change over time (hereinafter referred to as a speed profile) may be referred to rather than a movement command during acceleration / deceleration. ) Often decreases (see the broken line in FIG. 4), and accordingly, the actual dynamic torque indicated by the broken line becomes smaller than the dynamic torque calculated based on the command speed.
  • the dynamic torque is calculated using the angular movement amount and the actual speed when the acceleration is maximized, and the acceleration / deceleration time is corrected based on the dynamic torque. Has been eliminated.
  • FIG. 5 shows a procedure for correcting the acceleration / deceleration time according to this embodiment, and the acceleration / deceleration time is corrected by sequentially executing the five steps described below.
  • the acceleration time Ta and the deceleration time Tb are calculated in the target system (STEP 1).
  • ⁇ is a vector quantity having the joint angle of each joint axis of ⁇ a and ⁇ b as elements.
  • ⁇ is a vector amount having the angle movement amount of each joint axis as an element.
  • the movement distance L corresponds to a linear distance between work points.
  • the equation (2a) is set so that the speed of the joint axis falls within the permissible maximum speed.
  • the travel time Tm calculated from (1) is corrected.
  • a value obtained by dividing the movement angle of each joint axis by the maximum speed (the shortest movement time of the axis) The maximum value among them (which may be called) is defined as a movement time Tm.
  • Tm max ⁇ j / ⁇ jmax ⁇ (2b)
  • max ⁇ means that the largest one of the elements (one or more) in parentheses is selected.
  • ⁇ aj and ⁇ bj are j-axis joint angles at adjacent teaching points Pa and Pb, respectively, and Tm is the above-described movement time. Therefore, the target speed ⁇ c is a vector quantity having the target speed of each joint axis as an element. Note that ⁇ jc can be obtained in advance before PTP interpolation.
  • the shortest acceleration / deceleration time is calculated and output based on the target speed of each joint axis from each axis speed calculation unit 8.
  • the shortest acceleration time Tom about the j-axis is obtained as follows.
  • ⁇ jc is the j-axis target speed calculated by each axis speed calculator 8
  • ⁇ ajmax is the allowable maximum acceleration of the j-axis when accelerating only the j-axis alone at the teaching point Pa.
  • Acceleration time Ta when moving the robot arm 6 from the teaching point Pa is expressed by equation (5).
  • Ta max ⁇ Taj ⁇ (5)
  • max ⁇ means that the largest value is selected from a plurality of elements in parentheses.
  • the shortest deceleration time Tbj for the j axis is similarly expressed by the equation (6).
  • ⁇ bjmax is the allowable maximum acceleration of the j axis when only the j axis is decelerated alone at the teaching point Pb.
  • Tb max ⁇ Tbj ⁇ (7)
  • ⁇ STEP2 Create table> Next, the amount of angular movement and speed at which the actual acceleration is maximized are obtained, and the table 24 is created based on these values (STEP 2).
  • FIG. 6A shows the time change of acceleration, speed, and angular movement when acceleration / deceleration time is 100 msec
  • FIG. 6B shows the case where acceleration / deceleration time is 150 msec
  • FIG. Show. 6A to 6C the movement command and the acceleration based on the movement command are indicated by a broken line, and the actual value is indicated by a solid line.
  • FIG. 6A shows the acceleration, speed, and angular movement when the movement command is increased from 0 to 1 during 100 msec. Further, the amount of angular movement when the movement command is decreased from 1 to 0 during 100 msec is also shown. Similarly, in FIG.
  • the speed and acceleration of the rotating shaft during acceleration are smaller than the movement command and acceleration based thereon. This is based on the response delay of the servo control system as described above. Therefore, the actual acceleration / deceleration profile does not have a trapezoidal shape but a shape having a maximum value at time ta.
  • the actual acceleration ⁇ 100, speed ⁇ 100, and angular movement amount ⁇ a100 at time ta are arranged in association with the acceleration / deceleration time 100 msec.
  • the time at which the actual acceleration becomes maximum is time tb (not shown), and the angle up to the joint angle ⁇ b at time tb.
  • the movement amount ⁇ b100 is also arranged in the same manner as the acceleration ⁇ 100 and the like in association with the acceleration / deceleration time 100 msec.
  • the acceleration / deceleration time is changed to obtain values ⁇ 150, ⁇ 200, etc. corresponding to the acceleration ⁇ 100, respectively, and are arranged in association with the acceleration / deceleration time in the same manner as described above.
  • the table 24 shown in FIG. 7 is created, and the table 24 is stored in the storage unit 20.
  • the acceleration ⁇ 100, speed ⁇ 100, angular movement amount ⁇ a100, and the like may be obtained by actually measuring various sensors attached to the rotation axis of the robot arm 6 or may be obtained by other methods. For example, these values may be derived by simulation based on the block diagram shown in FIG. 8 using a servo control system model composed of the robot arm 6 and the robot controller 10 and each parameter. Good. In other words, after setting the acceleration / deceleration time, the temporal change of the speed and acceleration is derived by simulation, and the value at which the derived acceleration is maximized and the speed and angular movement at that time are obtained and incorporated in the table 24. To do.
  • control constant used for driving each joint axis is common to all axes, only one type of table 24 is prepared.
  • a 6-axis robot or the like may use different control constants for the basic axis and the wrist axis.
  • the acceleration / deceleration time is made common for each joint axis of the robot arm 6, and each data is acquired to create the table 24. Further, the number of data included in the table 24 is determined as appropriate according to the interval of acceleration / deceleration time.
  • ⁇ STEP3 Calculation of Dynamic Torque and Inertia Term Torque> Based on the table 24 created in STEP 2, the dynamic torque calculation unit 21 calculates the dynamic torque and inertia term torque of each joint axis (STEP 3).
  • the dynamic torque at the time ta and the time tb is calculated from constants (see FIG. 3) such as the link length, the position of the center of gravity of the robot arm 6, the position of the center of gravity, the moment of inertia of the link, and the inertia of the motor.
  • This dynamic torque is the torque of each joint axis required to operate at the speed ⁇ and acceleration ⁇ in the case of the joint angle ⁇ , and the joint angle ⁇ , speed ⁇ , and acceleration ⁇ are obtained from the components of each joint axis.
  • Vector quantity is the torque of each joint axis required to operate at the speed ⁇ and acceleration ⁇ in the case of the joint angle ⁇ , and the joint angle ⁇ , speed ⁇ , and acceleration ⁇ are obtained from the components of each joint axis.
  • ⁇ (t) H ( ⁇ (t)) ⁇ ⁇ (t) + D ⁇ ⁇ (t) + b ( ⁇ (t)) + c ( ⁇ (t)) (15)
  • H ( ⁇ (t)) is an inertia matrix at the joint angle ⁇ (t)
  • D is a viscosity matrix composed of viscosity coefficients
  • b ( ⁇ (t)) is the sum of the centrifugal force and the Coriolis force due to the velocity ⁇ (t) at the joint angle ⁇ (t) at time t
  • c ( ⁇ (t)) is the joint angle ⁇ (t ) Gravity torque.
  • Formula (15) can be derived
  • Expression (16) the right side of Expression (15) is divided into the first term and the other parts, and the form is expressed by Expression (16).
  • the first term on the right side of the equations (15) and (16) is a component that depends only on acceleration (hereinafter referred to as inertia term torque).
  • the second term of equation (16) is a component that depends on the speed ⁇ (t) (hereinafter referred to as speed-dependent term torque), and the second term is a component that depends on gravity (hereinafter referred to as gravity term torque). is there.
  • ⁇ c (t) may be referred to as residual torque.
  • the dynamic torque calculation unit 21 substitutes the acceleration ⁇ ap, the speed ⁇ ap, the joint angle ⁇ ap, the acceleration ⁇ bp, the speed ⁇ bp, and the joint angle ⁇ bp at the time ta described above into the equations (16) to (19) to obtain the time Inertia term torque ⁇ ap, velocity dependent term torque ⁇ dap, gravity term torque ⁇ eap at ta, inertia term torque ⁇ bp at time tb, velocity dependent term torque ⁇ dbp, and gravity term torque ⁇ ebp are calculated.
  • the dynamic torque ⁇ 1 (t) of the first axis and the dynamic torque ⁇ 2 (t) of the second axis are expressed by equations (21) and (22), respectively.
  • ⁇ 1 (t) (H11 ⁇ ⁇ 1 + H12 ⁇ ⁇ 2) + (D11 ⁇ ⁇ 1 + b1) + c1 (21)
  • ⁇ 2 (t) (H21 ⁇ ⁇ 1 + H22 ⁇ ⁇ 2) + (D22 ⁇ ⁇ 2 + b2) + c2 (22)
  • H11 m1 ⁇ lg1 2 + m2 ⁇ L1 2 + m2 ⁇ lg2 2 + I1 + I2 + 2 ⁇ m2 ⁇ L1 ⁇ lg2 ⁇ cos ⁇ 2 + Jm1 (23)
  • H12 m 2 ⁇ lg 2 2 + I 2 + m 2 ⁇ L 1 ⁇ lg 2 ⁇ cos ⁇ 2 (24)
  • H21 m2 ⁇ lg2 2 + I2 + m2 ⁇ L1 ⁇ lg2 ⁇ cos ⁇ 2 (25)
  • H22 m2 ⁇ lg2 2 + I2 + Jm2 (26)
  • ⁇ 1 The rotation angle of the first axis at time t (the counterclockwise direction on the paper is the positive direction)
  • ⁇ 2 rotation angle of the second axis at time t (the counterclockwise direction on the paper is defined as the positive direction)
  • ⁇ 1 rotation speed of the first axis at time t
  • ⁇ 2 rotation speed of the second axis at time t
  • ⁇ 1 rotation acceleration of the first axis at time t
  • ⁇ 2 rotation acceleration of the second axis at time t
  • m1 rotation of the first axis
  • the center-of-gravity mass of the link m2 The center-of-gravity mass of the link of the second axis, and m2 includes the mass of the load at the end of the link.
  • FIG. 9 shows temporal changes in joint angle, speed, acceleration, and dynamic torque during acceleration / deceleration on the j-axis.
  • FIG. 9 is also a schematic diagram showing a concept for deriving the correction coefficient ⁇ .
  • the correction processing unit 22 calculates the dynamic torque, inertia term torque, and torque other than the inertia term torque at a predetermined time calculated by the dynamic torque calculation unit 21 (speed-dependent term torque, gravity term torque).
  • the first and second correction coefficients ⁇ a and ⁇ b are calculated and output based on the above.
  • the maximum torque that can be output on the j-axis is the allowable maximum torque ⁇ jmax.
  • the amount of change in the gravity term torque and the speed-dependent term torque before and after the times ta and tb are sufficiently smaller than the amount of change in the inertia term torque.
  • torque ⁇ brj shown in Expression (35) is calculated using allowable maximum torque ⁇ jmax related to j-axis and residual torque ⁇ cbpj of j-axis at time tb.
  • the sign of the allowable maximum torque ⁇ jmax is set to the same sign as the dynamic torque ⁇ j (tb) at time tb.
  • the torque ⁇ arj shown in the equation (33) and the torque ⁇ brj in the equation (35) can be used among the allowable maximum torque ⁇ jmax of the j-axis when performing the acceleration / deceleration rotation operation at the maximum acceleration on the j-axis. This corresponds to torque (hereinafter, sometimes referred to as available torque).
  • the inertia term torques ⁇ apj and ⁇ bj are torques necessary for realizing the acceleration / deceleration rotation operation at the maximum acceleration on the j-axis.
  • ⁇ aj and ⁇ bj shown in equations (34) and (36) are 1 or less, the j-axis can be accelerated and decelerated and rotated at a predetermined maximum acceleration.
  • ⁇ aj and ⁇ bj are larger than 1, the j-axis means that there is not enough torque necessary to realize a desired operation.
  • correction coefficients are calculated by the equations (33) to (36), respectively, and the maximum correction coefficient obtained during the acceleration operation is selected to obtain the first correction.
  • the coefficient is ⁇ a.
  • the maximum correction coefficient obtained during the deceleration operation is selected as the second correction coefficient ⁇ b.
  • ⁇ a and ⁇ b may be collectively referred to as correction coefficient ⁇ .
  • ⁇ STEP5 Correction of acceleration / deceleration time>
  • the calculation unit 23 multiplies the acceleration time Ta calculated by the acceleration / deceleration time calculation unit 9 by the first correction coefficient ⁇ a calculated by the correction processing unit 22 to obtain a corrected acceleration time Ta ′. Output to the deceleration processing unit 4. Further, the calculation unit 23 multiplies the deceleration time Tb calculated by the acceleration / deceleration time calculation unit 9 by the second correction coefficient ⁇ b calculated by the correction processing unit 22 to obtain a corrected deceleration time Tb ′. And output to the acceleration / deceleration processing unit 4.
  • Ta ′ and Tb ′ are expressed by equations (39) and (40), respectively.
  • Ta ′ Ta ⁇ ⁇ a (39)
  • Tb ′ Tb ⁇ ⁇ b (40)
  • the corrected acceleration time Ta ′ and deceleration time Tb ′ obtained by multiplying the first and second correction coefficients ⁇ a and ⁇ b are the same as the initial acceleration time Ta and deceleration time Tb.
  • the joint axis is rotated at a new acceleration time Ta ′ (> Ta) obtained by multiplying the initial acceleration time Ta by ⁇ a (> 1).
  • Ta initial acceleration time
  • the initial acceleration of the joint axis is reduced to 1 / ⁇ a times, that is, the inertia term torque is reduced to 1 / ⁇ a times.
  • the j-axis dynamic torque ⁇ j corrected by the first correction coefficient ⁇ a does not exceed the allowable maximum torque ⁇ jmax.
  • the j-axis dynamic torque ⁇ j corrected by the second correction coefficient ⁇ b does not exceed the allowable maximum torque ⁇ jmax.
  • the acceleration / deceleration processing unit 4 performs the above-described acceleration / deceleration processing on the movement command sequence output from the movement command generation unit 3 using the corrected acceleration time Ta ′ or deceleration time Tb ′.
  • the robot control apparatus 10 controls the operation of the robot arm 6 having a plurality of sets of motors and joint axes that are rotationally driven by the motors.
  • the robot control device 10 calculates a dynamic torque in each joint axis based on the rotational speed, rotational acceleration, and joint angle of each joint axis, and outputs the dynamic torque in each joint axis.
  • the movement amounts ⁇ ap, ⁇ bp of the joint angles, the rotational speeds ⁇ ap, ⁇ bp, the maximum values ⁇ ap of the rotational acceleration, and the minimum values ⁇ bp of the joint axes at the time points ta, tb at which the rotational acceleration becomes maximum and minimum are added to each joint axis. It includes at least a table 24 stored in association with acceleration / deceleration times Ta and Tb for decelerating operation, and a storage unit 20 in which the table 24 is stored.
  • the dynamic torque calculation unit 21 calculates the dynamic torque corresponding to the maximum value ⁇ ap and the minimum value ⁇ bp of the rotational acceleration, and also corresponds to the maximum value ⁇ ap and the minimum value ⁇ bp of the rotational acceleration. Inertia torques ⁇ ap, ⁇ bp to be calculated and residual torques ⁇ cap, ⁇ cbp obtained by subtracting the inertial term torque from the dynamic torque, and at least one of the joint axes, the inertia term torque ⁇ ap is applied to each joint axis.
  • the present embodiment in an articulated robot, it can be detected in advance whether or not the torque necessary for acceleration / deceleration at each joint axis is insufficient. If the torque is insufficient, the acceleration time Ta or the deceleration time Tb is detected. And the rotation of the joint shaft can be accelerated with a torque within a range that can be output, and the operation of the robot arm 6 can be controlled. Thus, the trouble of correcting the teaching of the robot operation program 1 can be saved.
  • the robot control device 10 generates a movement command ⁇ for each joint axis based on the distance L between adjacent work points in the robot arm 6 and the target movement speed V, and outputs the movement command ⁇ .
  • the torque ratio between the available torque which is a component obtained by subtracting the residual torque ⁇ cap or ⁇ cbp from the allowable maximum torque ⁇ jmax that can be output by the j-axis that is one joint axis, and the inertial term torques ⁇ ap, ⁇ bp is calculated.
  • a correction processing unit 22 that calculates the torque ratio in each shaft and outputs the maximum value of the torque ratios in each joint shaft as a correction coefficient ⁇ .
  • the robot control apparatus 10 performs acceleration / deceleration processing on the movement command ⁇ based on a preset acceleration time Ta or deceleration time Tb, and when the correction coefficient ⁇ exceeds 1.
  • an acceleration / deceleration processing unit 4 that performs acceleration / deceleration processing of the movement command ⁇ based on the acceleration time Ta ′ or the deceleration time Tb ′ corrected by multiplying the acceleration time Ta or the deceleration time Tb by the correction coefficient ⁇ .
  • the operation of the robot arm 6 is controlled by rotationally driving each joint axis based on the movement command ⁇ subjected to acceleration / deceleration processing by the acceleration / deceleration processing unit 4.
  • the present embodiment in an articulated robot, it is possible to detect in advance whether or not the torque necessary for acceleration at each joint axis is insufficient. If the torque is insufficient, the value is in accordance with the shortage.
  • the acceleration time Ta With the first correction coefficient ⁇ a (> 1) and setting the acceleration time Ta to a time Ta ′ larger than the initial value, the rotational movement of the joint shaft can be performed with a torque within the output range.
  • the operation of the robot arm 6 can be controlled.
  • the trouble of correcting the teaching of the robot operation program 1 can be saved.
  • the deceleration time Tb is corrected by the second correction coefficient ⁇ b (> 1), which is a value corresponding to the shortage of torque, and the deceleration time Tb is set to a time Tb ′ larger than the initial value. It is possible to control the operation of the robot arm 6 by decelerating the rotation of the joint shaft with a torque within a possible range. Thus, the trouble of correcting the teaching of the robot operation program 1 can be saved.
  • the acceleration time Ta and / or the deceleration time Tb is corrected based on the dynamic torque at the time when the actual acceleration is maximized or minimized, that is, the time when the acceleration / deceleration operation is most rapidly performed on the joint axis. Therefore, it is possible to suppress an increase in tact, which is the operation time of the robot arm 6, while stably operating the robot arm 6.
  • the value stored in the table 24 may be calculated based on the movement command.
  • the acceleration / deceleration profile is trapezoidal, but it goes without saying that the present invention can be applied to other profiles.
  • the robot controller of the present invention can automatically adjust the acceleration / deceleration time so that the torque required for each joint axis does not exceed the torque that can be output when the robot arm is moved while suppressing an increase in tact.
  • teaching correction of the robot operation program can be reduced, teaching work can be performed efficiently, and it is extremely useful when applied to a robot having a plurality of axes.

Landscapes

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

Abstract

多関節型のロボットアーム６の動作を制御するロボット制御装置１０は、各関節軸の動力学トルクを算出する動力学トルク算出部２１と、各関節軸の回転加速度が極大となる時点ｔａでの角度移動量Δθａｐと回転速度ωａｐと回転加速度αａｐとが加速時間Ｔａに関連付けられて保存されたテーブル２４を有する記憶部２０と、を備えている。動力学トルク算出部２１は、回転加速度αａｐに対応する慣性項トルクτａｐと残余トルクτｃａｐを算出するとともに、ｊ軸において、慣性項トルクτａｐｊが許容最大トルクτｊｍａｘと残余トルクτｃａｐとの差である利用可能トルクよりも大きい場合は加速時間Ｔａを補正する。

Description

ロボット制御装置
　本発明は、ロボットの動作制御に係るロボット制御装置に関する。
　モータによって回転駆動される関節軸を複数組備えた多関節型ロボットにおいて、ロボットアームを教示点間で高速移動させる場合、急激な加減速によって関節軸を駆動するモータに過大な負荷がかかることがある。
　特許文献１には、各関節軸の最大または最小加速度到達時間を一定に保持したまま、動力学モデルを用いて求めたトルクが目標トルクになるように、基準関節軸の最大または最小加速度を修正する技術が開示されている。このようにすることで、加減速時のロボットアームの振動を抑えて、スムーズな加減速動作を行うことができる。
特開２０１０－２６９３８５号公報
　ところで、関節軸に発生するトルクは、当該関節軸に連結されたモータの出力トルクに依存し、当該モータの許容最大トルクによって制限される。すなわち、複数の関節軸が同時に動作する場合に、関節軸を動作させるのに必要なトルクが不足する場合がある。
　例えば、加速時にトルクが不足したまま関節軸を回転させると、当該関節軸だけが遅れた動作となりアーム先端の軌道が予想外の軌道をたどる場合がある。すなわち、ロボットが周辺物と接触する恐れがある。また、減速時に必要なトルクが不足すると、目標教示点でオーバシュートする場合がある。その場合も、周辺物との接触の恐れがある。
　通常、これらのような場合は、ロボットアームの動作プログラムの修正を行う。具体的には、加減速時間を調整する命令を加えたり、目標動作速度を変更したりして対応する。
　しかし、この修正作業は、実際に動作プログラムを運転してカットアンドトライで行う必要があり、工数を要していた。
　また、特許文献１に示す構成では、各関節軸の最大または最小加速度到達時間を一定に保持したまま、動力学モデルを用いて求めたトルクが目標トルクになるように、基準関節軸の最大または最小加速度を修正している。
　しかし、この場合は、ロボットアームの動作は安定するものの、ロボットアームの動作時間であるタクトは増加してしまう。
　本発明は、かかる点に鑑みてなされたもので、ロボットのタクトが増加するのを抑えつつ、関節軸を動作させるのに必要なトルクがモータの許容最大トルクを超えないように、加減速時間を自動調整する仕組みを備えたロボット制御装置を提供することにある。
　上記目的を達成するため、本発明に係るロボット制御装置は、モータと該モータによって回転駆動される関節軸とを複数組有するロボットアームの動作を制御するロボット制御装置であって、各関節軸の回転速度と回転加速度と関節角度に基づいて、各関節軸における動力学トルクをそれぞれ算出して出力する動力学トルク算出部と、各関節軸の回転加速度が極大及び極小となる時点での各関節軸における関節角度の移動量と回転速度と前記回転加速度の極大値及び極小値とが各関節軸を加減速動作させるための加減速時間に関連付けられたテーブルを有する記憶部と、を少なくとも備え、前記動力学トルク算出部は、前記テーブル内の値に基づいて、前記回転加速度の極大値及び極小値に対応する動力学トルクを算出するとともに、前記回転加速度の極大値及び極小値に対応する慣性項トルクと、前記動力学トルクから前記慣性項トルクを差し引いた残余トルクとを算出し、各関節軸のうち少なくとも１つの関節軸において、前記慣性項トルクが各関節軸を所定の加速度で加減速動作させるに利用可能な利用可能トルクよりも大きい場合は、各関節軸の回転動作における共通の加減速時間を補正することを特徴とする。
　この構成によれば、各関節軸の動作に必要なトルクの不足を予め検知でき、トルクの不足分に応じた値で加減速時間または移動時間を補正して、これらの値のいずれかを当初の値よりも大きくすることで、出力可能な範囲内のトルクで関節軸を回転駆動させて、ロボットアームの動作を制御することができる。このことにより、ロボットの動作プログラムの教示修正の手間を省くことができる。また、実際の加速度が極大または極小となる時刻、つまり、関節軸での加減速動作が最も急激に行われる時刻での動力学トルクに基づいて、加減速時間を補正するため、ロボットアームを安定して動作させつつ、ロボットアームの動作時間であるタクトが増加するのを抑えることができる。
　以上説明したように、本発明に係るロボット制御装置によれば、ロボットアームを動作させるときの各関節軸で必要なトルクがその出力可能トルクを超えないように、加減速時間を自動調整することができ、ロボットの動作プログラムの教示修正の手間を省くことができる。また、ロボットのタクトが増加するのを抑制することができる。
図１は、本発明の一実施形態に係るロボット制御装置の機能ブロック図である。 図２は、異なる関節軸での関節角度、速度及び加速度の時間変化を示す図である。 図３は、２軸ロボットの構成を示す模式図である。 図４は、ｊ軸における加速時の速度、加速度及び動力学トルクの時間変化を示す図である。 図５は、本発明の一実施形態に係る加減速時間の補正手順を示すフローチャートである。 図６Ａは、加減速時間が１００ｍｓｅｃ場合の加速度、速度、角度移動量の時間変化を示す図である。 図６Ｂは、加減速時間が１５０ｍｓｅｃ場合の加速度、速度、角度移動量の時間変化を示す図である。 図６Ｃは、加減速時間が２００ｍｓｅｃ場合の加速度、速度、角度移動量の時間変化を示す図である。 図７は、テーブルの構成を示す図である。 図８は、角度移動量、速度及び加速度を導出するためのブロック線図である。 図９は、ｊ軸における加減速時の関節角度、速度、加速度及び動力学トルクの時間変化を示す図である。
　以下、本発明の実施形態を図面に基づいて詳細に説明する。以下の好ましい実施形態の説明は、本質的に例示に過ぎず、本発明、その適用物或いはその用途を制限することを意図するものでは全くない。
　（実施形態）
　［ロボット制御装置の機能ブロック構成］
　図１は、本実施形態に係るロボット制御装置の機能ブロック構成を示し、図２は、異なる関節軸であるｉ軸及びｊ軸における速度及び加速度の時間変化を示し、図３は、２軸ロボットの模式図を示す。なお、以降の説明において示す添字ｉ，ｊは整数で１≦ｉ，ｊ≦ｎかつｉ≠ｊであり、ｎはロボットアーム６に含まれる関節軸の個数である。なお、以降の説明において、回転軸であるｉ軸やｊ軸の回転速度や回転加速度を単にｉ軸やｊ軸の速度や加速度と呼ぶことがある。
　ロボット制御装置１０は、動作プログラム１と、処理部２と、移動指令生成部３と、加減速処理部４と、サーボ５と、移動時間算出部７と、各軸速度算出部８と、加減速時間算出部９と、記録部２０と、動力学トルク算出部２１と、補正処理部２２と、演算部２３とを機能ブロックとして備えている。なお、図１に示す機能ブロックは、記録部２０に保存された、または外部から読み込まれたソフトウェアをロボット制御装置１０に設けられた図示しないＣＰＵ（Ｃｅｎｔｒａｌ　Ｐｒｏｃｅｓｓｉｎｇ　Ｕｎｉｔ）等の演算装置上で実行することで実現される。このソフトウェアに動作プログラム１が含まれていてもよい。また、説明の便宜上、ロボットアーム６に組み込まれた関節軸と、当該関節軸に連結されて関節軸を回転駆動するモータとで構成される複数の組については図示を省略している。
　動作プログラム１には、ロボットアーム６の教示点位置と、教示点間を結ぶ軌跡の形状にあたる補間形態と、目標移動速度とが記録されている。教示点位置は、直交空間上の作業点位置またはロボットアーム６の関節角度である。目標移動速度は、教示点間を指示された補間形態で移動するときの目標速度である。
　補間形態としては、直交空間上の作業点を、直線や円弧等の特定の形状を描くように補間するＣＰ（ｃｏｎｔｉｎｕａｓ　ｐａｔｈ）補間と、各関節軸を一定の速度で動かし、作業点の軌跡の形状は問わないＰＴＰ（ｐｏｉｎｔ　ｔｏ　ｐｏｉｎｔ）補間とがあるが、以降は、ＰＴＰ補間を行う場合について説明する。ＰＴＰ補間は教示点間を最短時間で移動する場合に適用する補間形態であり、ロボットアーム６の関節軸のいずれかもしくは複数が、その最大速度で回転するように動作させることが多い。
　処理部２は、動作プログラム１に記録されている教示点位置が直交空間上の値である場合に、それをロボットアーム６の各関節軸の関節角度に変換し、また、教示点位置がロボットアーム６の関節角度の場合は直交空間上の値に変換する。なお、以降の説明において、動作プログラム１上に記録された任意の教示点をＰａとし、その次の教示点をＰｂとする。
　移動指令生成部３は、隣り合う教示点間の移動量と目標移動速度とに基づいて移動指令を生成して出力する。この移動指令は単位時間当たりの関節角移動量（以下、単に角度移動量と呼ぶことがある。）である。各関節の角度移動量をまとめて１組とし、これを１つの移動指令とする。よって、移動指令はベクトル量である。移動指令生成部３は、後述する移動時間に対応する複数組の移動指令を時系列的に出力する。この時系列的に出力される複数組の移動指令を移動指令列と言う。なお、移動指令生成部３が出力する移動指令列には後述する加減速処理はなされていない。
　加減速処理部４は、移動指令生成部３からの移動指令列に対して加減速処理を行って、加減速した移動指令を出力する。加減速処理部４は、後述する加減速時間算出部９が出力する加速時間で目標移動速度に達するように、移動指令生成部３からの移動指令列を加減速処理する。具体的には、図２に示すように、各関節軸における加速度を時間変化させて所定の目標移動速度に到達するようにする。また、教示点Ｐｂ手前で目標移動速度から減速を始めて、加減速時間算出部９が出力する減速時間が経過した後に教示点Ｐｂに到達するように、移動指令生成部３からの移動指令列を減速処理する。なお、以降の説明において、加速度の時間変化波形を加速プロファイルまたは減速プロファイルあるいは加減速プロファイルと呼ぶことがある。なお、図２に示すように、加減速プロファイルは、ロボットアーム６の振動を誘発しないように時間に対して速度がＳ字状に変化する形状とする。なお、加減速処理は後述する演算部２３が出力する補正後の加速時間または減速時間に基づいて行い、具体的な加減速処理の手順については後述する。
　サーボ５は、加減速処理部４で処理された移動指令列に基づいて、各関節軸に連結されたモータを回転駆動させてロボットアーム６の動作を制御する。
　移動時間算出部７は、ロボットアーム６の先端が教示点Ｐａから教示点Ｐｂへ加減速せずに目標移動速度で移動するのに要する所要時間を算出して出力する。当該所要時間が移動時間に相当する。
　各軸速度算出部８は、ＰＴＰ補間時の各関節軸の目標速度を算出し出力する。
　加減速時間算出部９は、教示点Ｐａから目標速度に加速するときの加速時間、教示点Ｐｂ手前で目標速度から減速して教示点Ｐｂに到達するときの減速時間を求め出力する。
　記憶部２０は、後述するテーブル２４（図７参照）や動作プログラム１を保存しており、ロボット制御装置１０の各部からの要求に従って保存されたデータを対応するブロックに送信する。
　動力学トルク算出部２１は、テーブル２４内のデータに基づいて、所定の時刻における各関節軸の動力学トルクをそれぞれ算出し出力する。
　補正処理部２２は、動力学トルク算出部２１で算出された、所定の時刻における動力学トルク、慣性項トルク及び慣性項トルク以外のトルクに基づいて、後述する第１及び第２補正係数γａ，γｂを算出し出力する。
　演算部２３は、加減速時間算出部９で算出された加速時間Ｔａまたは減速時間Ｔｂに対して、補正処理部２２で算出された第１または第２補正係数γａ，γｂを乗じて、補正後の加速時間Ｔａ’または減速時間Ｔｂ’を求め、加減速処理部４に出力する。
　テーブル２４は、ロボットアーム６の各関節軸が駆動するときに、極大または極小となる実加速度及びそのときの速度と角度移動量が加減速時間に関連付けて配列されたテーブルである。
　なお、加速時間は、例えば、教示点Ｐａから加速を始めて目標移動速度に達するまでの時間をいい、減速時間とは、例えば、教示点Ｐｂの手前で減速を始めて移動速度が零になるまでの時間をいい、加減速時間とは、これら両者を合わせた時間をいう。また、各関節軸について、各関節軸の許容最大加速度で目標速度まで加速したときの加速時間（各軸の最短加速時間と呼ぶことがある）を求め、これら各関節軸における最短加速時間の中で値が最大のものを選び、これを全軸共通の加速時間とする。図２に示すように、全ての関節軸はこの全軸共通の加速時間で加速する。また、減速時には、各関節軸における最短減速時間の中で値が最大のものを選び、これを全軸共通の減速時間とする。加速時と同様に、全ての関節軸はこの全軸共通の減速時間で減速する（図２参照）。
　従って、テーブル２４における加減速時間は全軸共通の加減速時間である。なお、テーブル２４の構成及び作成手順については後述する。
　［加減速時間の補正手順］
　図４は、ｊ軸における加速時の速度、加速度及び動力学トルクの時間変化を示す。なお、図４では、ｊ軸の速度に相当する移動指令生成部３から出力された移動指令に基づいて算出された加速度やトルクを示している。また、図４において、実線は、移動指令に基づいて算出された動力学トルクを示し、破線は、実際にｊ軸に加わる動力学トルクを示す。
　図４に示すように、動力学トルクは、加速度の上昇に伴い増加し、時刻ｔ２で最大値になった後、加速度の低下に伴い減少する。ここで、ｊ軸が出力可能な最大トルクをｊ軸に関する許容最大トルクτｊｍａｘとすると、時刻ｔ１からｔ３までの期間で、移動指令に基づいて算出された動力学トルクが許容最大トルクτｊｍａｘを上回っている。これは、関節軸を駆動させるトルクが足らないことを意味する。このような場合には、例えば、加速時間を増加させる補正を行って、動力学トルクが許容最大トルクτｊｍａｘ以下になるように調整する必要がある。
　しかし、ロボットアーム６が接続された実際のロボット制御装置１０では、サーボ制御系の遅れ等により、加減速時の移動指令よりも実際の速度の時間変化（以下、速度プロファイルと呼ぶことがある。）が小さくなることが多く（図４中の破線参照）、これに伴い、破線で示す実際の動力学トルクが指令速度に基づいて算出された動力学トルクよりも小さくなる。
　よって、図４に示すように、実際には動力学トルクが許容最大トルクτｊｍａｘを超えていないにも関わらず、加速時間を増加させる補正が必要と判断されてしまうことがある。この場合、タクトが増加するため、ロボットアーム６を用いた作業の生産性が低下するという問題があった。
　そこで、本実施形態では、加速度が極大となるときの角度移動量や実速度を用いて動力学トルクを算出し、この動力学トルクに基づいて加減速時間の補正を行うことで、上記の不具合を解消している。
　＜ＳＴＥＰ１：加減速時間の算出＞
　図５は、本実施形態に係る加減速時間の補正手順を示し、以降で説明する５つのステップを順次実行して加減速時間の補正を行う。
　まず、対象となる系において、加速時間Ｔａ及び減速時間Ｔｂを算出する（ＳＴＥＰ１）。
　ＰＴＰ補間の場合、教示点Ｐａ、Ｐｂでの関節角度をそれぞれθａ、θｂとし、教示点間に対応する作業点間の移動時間をＴｍ、補間の単位時間をＴｈとするとき、移動指令Δθは、式（１）で表わされる。なお、移動時間Ｔｍは移動時間算出部７で算出される。
　Δθ＝（θｂ－θａ）・Ｔｈ／Ｔｍ　・・・（１）
　ここで、θａ、θｂ各関節軸の関節角度を要素とするベクトル量である。また、Δθは各関節軸の角度移動量を要素とするベクトル量である。
　教示点Ｐａ，Ｐｂに対応する作業点間の移動距離をＬ、目標移動速度をＶとするとき、移動時間Ｔｍは、式（２ａ）で表わされる。
　Ｔｍ＝Ｌ／Ｖ　・・・（２ａ）
　なお、ＰＴＰ補間の場合、移動距離Ｌは、作業点間の直線距離に相当する。また、関節軸を加速または減速回転させてロボットアーム６を動作させる際に、自身の許容最大速度を超える関節軸がある場合は、当該関節軸の速度が許容最大速度に収まるように式（２ａ）から算出された移動時間Ｔｍは修正される。
　また、ＰＴＰ補間において、教示点Ｐａ，Ｐｂに対応する作業点間を最短時間で移動する場合は、各関節軸の移動角度をその最大速度で除して得る値（当該軸の最短移動時間と呼ぶことがある）の中の最大値を移動時間Ｔｍとする。
　すなわち、複数の関節軸のうちｊ軸の移動角度をΔθｊ、最大速度をωｊｍａｘとするとき、移動時間Ｔｍは式（２ｂ）で表わされる。
　Ｔｍ＝ｍａｘ｛Δθｊ／ωｊｍａｘ｝　・・・（２ｂ）
　ここで、ｍａｘ｛｝は括弧内の要素（１個もしくは複数個）のうちの最大のものを選択することを意味する。
　また、各軸速度算出部８で算出されたｊ軸に関する目標速度ωｊｃは、式（３）で表わされる。
　ωｊｃ＝（θｂｊ－θａｊ）／Ｔｍ　・・・（３）
　ここで、θａｊ、θｂｊはそれぞれ、隣り合う教示点Ｐａ、Ｐｂでのｊ軸の関節角度であり、Ｔｍは上述した移動時間である。よって、目標速度ωｃは各関節軸の目標速度を要素とするベクトル量である。なお、ωｊｃはＰＴＰ補間前に予め値を求めることができる。
　ＰＴＰ補間の場合は、各軸速度算出部８からの各関節軸の目標速度に基づいて、最短の加減速時間を算出し出力する。
　まず、ｊ軸についての最短加速時間Ｔａｊを次のように求める。
　Ｔａｊ＝｜ωｊｃ｜／αａｊｍａｘ　・・・（４）
　ここで、ωｊｃは各軸速度算出部８で算出されたｊ軸の目標速度、αａｊｍａｘは、教示点Ｐａにおいてｊ軸だけを単独で加速する場合のｊ軸の許容最大加速度である。
　教示点Ｐａからロボットアーム６を移動させるときの加速時間Ｔａは、式（５）で表わされる。
　Ｔａ＝ｍａｘ｛Ｔａｊ｝　・・・（５）
　ここで、ｍａｘ｛｝は括弧内の複数の要素から値が最大のものを選択することを意味する。
　ｊ軸についての最短減速時間Ｔｂｊについても同様に式（６）で表わされる。
　Ｔｂｊ＝｜ωｊｃ｜／αｂｊｍａｘ　・・・（６）
　ここで、αｂｊｍａｘは、教示点Ｐｂにおいてｊ軸だけを単独で減速する場合のｊ軸の許容最大加速度である。
　従って、教示点Ｐｂへロボットアーム６を移動させるときの減速時間Ｔｂは、式（７）で表わされる。
　Ｔｂ＝ｍａｘ｛Ｔｂｊ｝　・・・（７）
　＜ＳＴＥＰ２：テーブル作成＞
　次に、実際の加速度が極大となるときの角度移動量や速度を求め、これらに基づいてテーブル２４を作成する（ＳＴＥＰ２）。
　図６Ａは、加減速時間が１００ｍｓｅｃの場合の、図６Ｂは、加減速時間が１５０ｍｓｅｃの場合の、図６Ｃは、加減速時間が２００ｍｓｅｃの場合の加速度、速度、角度移動量の時間変化をそれぞれ示す。図６Ａ～６Ｃにおいて、移動指令及びそれに基づいた加速度を破線で示し、実際の値を実線で示している。なお、図６Ａでは、１００ｍｓｅｃの間に移動指令を０から１まで増加させたときの加速度、速度、角度移動量を示している。また、１００ｍｓｅｃの間に移動指令を１から０まで減少させたときの角度移動量もあわせて図示している。同様に、図６Ｂでは、１５０ｍｓｅｃの間に移動指令を０から１まで増加させたときの加速度、速度、角度移動量を、図６Ｃでは、２００ｍｓｅｃの間に移動指令を０から１まで増加させたときの加速度、速度、角度移動量をそれぞれ示している。
　図６Ａに示すように、加速中の回転軸の速度及び加速度は、移動指令及びそれに基づく加速度よりも小さくなっている。これは、前述したように、サーボ制御系の応答遅れ等に基づく。従って、実際の加減速プロファイルは台形形状とならずに、時刻ｔａで極大値を有する形状となる。時刻ｔａにおける実際の加速度α１００，速度ω１００、角度移動量Δθａ１００を加減速時間１００ｍｓｅｃに関連付けて配列する。また、図示しないが、１００ｍｓｅｃの間に移動指令を１から０まで減少させたときに、実際の加速度が極大となる時刻を時刻ｔｂ（図示せず）とし、時刻ｔｂにおける関節角度θｂまでの角度移動量Δθｂ１００も加減速時間１００ｍｓｅｃに関連付けて加速度α１００等と同様に配列する。
　図６Ｂ，６Ｃに示すように、加減速時間を変化させて、それぞれ、加速度α１００に対応する値α１５０，α２００等を求めて、上記と同様に加減速時間に関連付けて配列する。このようにして図７に示すテーブル２４を作成し、テーブル２４は記憶部２０に保存される。
　なお、加速度α１００，速度ω１００、角度移動量Δθａ１００等は、実際のロボットアーム６の回転軸に各種センサを取付けて実測して求めてもよいし、他の方法で求めてもよい。例えば、ロボットアーム６とロボット制御装置１０とで構成されるサーボ制御系のモデル及び各パラメータを用いて、図８に示すブロック線図に基づいて、シミュレーションによりこれらの値を導出するようにしてもよい。つまり、加減速時間を設定した後に、シミュレーションにより速度、加速度の時間変化を導出し、導出された加速度が極大となる値及びその時刻での速度、角度移動量を求めてテーブル２４に組み込むようにする。なお、各関節軸の駆動に用いられる制御定数は、全軸共通であるため、テーブル２４は１種類だけ準備される。ただし、６軸ロボット等では基本軸と手首軸とで異なる制御定数を用いる場合もある。このような場合は、図７には図示していないが、ロボットアーム６の関節軸のそれぞれについて加減速時間を共通とした上で、各データが取得されてテーブル２４が作成される。また、テーブル２４に含まれるデータの個数は、加減速時間の間隔により適宜決められる。
　＜ＳＴＥＰ３：動力学トルク及び慣性項トルクの算出＞
　ＳＴＥＰ２で作成したテーブル２４に基づいて、動力学トルク算出部２１で各関節軸の動力学トルク及び慣性項トルクをそれぞれ算出する（ＳＴＥＰ３）。
　具体的には、テーブル２４内の以下のパラメータ、加速度が極大となる時刻ｔａにおける加速度αａｐ、速度ωａｐ、関節角度θａｐ、加速度が極小となる時刻ｔｂにおける加速度αｂｐ、速度ωｂｐ、関節角度θｂｐ、また、ロボットアーム６のリンク長、重心位置、重心質量、リンクの慣性モーメント、モータのイナーシャ等の定数（図３参照）から、時刻ｔａ及び時刻ｔｂでの動力学トルクを算出する。
　この動力学トルクは、関節角度θの場合に、速度ω及び加速度αで動作するのに必要な各関節軸のトルクであり、関節角度θ、速度ω、加速度αは、各関節軸の成分からなるベクトル量である。
　また、時刻ｔにおける動力学トルクは式（１５）で表わされる。
　τ（ｔ）＝Ｈ（θ（ｔ））・α（ｔ）＋Ｄ・ω（ｔ）＋ｂ（ω（ｔ））＋ｃ（θ（ｔ））　・・・（１５）
　ここで、Ｈ（θ（ｔ））は関節角度θ（ｔ）における慣性行列であり、Ｄは粘性係数からなる粘性行列である。さらに、ｂ（ω（ｔ））は、時刻ｔでの関節角度θ（ｔ）における速度ω（ｔ）による遠心力、コリオリ力の和、ｃ（ω（ｔ））は、関節角度θ（ｔ）における重力トルクである。また、なお、式（１５）は、ラグランジュ法またはニュートンオイラー法によりロボットアーム６の運動方程式を立てて解くことで導出できる。
　ここで、式（１５）の右辺を、第１項とそれ以外の部分とに分けて、式（１６）で表わされる形式とする。なお、式（１５）、（１６）の右辺の第１項は加速度のみに依存する成分（以下、慣性項トルクという。）である。また、式（１６）の第２項は速度ω（ｔ）に依存する成分（以下、速度依存項トルクという。）、第２項は重力に依存する成分（以下、重力項トルクという。）である。なお、以降の説明において、τｃ（ｔ）を残余トルクと呼ぶことがある。
　τ（ｔ）＝τａ（ｔ）＋τｄ（ｔ）＋τｅ（ｔ）＝τａ（ｔ）＋τｃ（ｔ）　・・・（１６）
　ただし、
　τａ（ｔ）＝Ｈ（θ（ｔ））・α（ｔ）　・・・（１７）
　τｄ（ｔ）＝Ｄ・ω（ｔ）＋ｂ（ω（ｔ））　・・・（１８）
　τｅ（ｔ）＝ｃ（（ω（ｔ））　・・・（１９）
　τｃ（ｔ）＝τｄ（ｔ）＋τｅ（ｔ）　・・・（２０）
　動力学トルク算出部２１では、上述した時刻ｔａにおける加速度αａｐ、速度ωａｐ、関節角度θａｐ、時刻ｔｂにおける加速度αｂｐ、速度ωｂｐ、関節角度θｂｐを式（１６）～（１９）に代入して、時刻ｔａでの慣性項トルクτａｐ、速度依存項トルクτｄａｐ、重力項トルクτｅａｐ及び時刻ｔｂでの慣性項トルクτｂｐ、速度依存項トルクτｄｂｐ、重力項トルクτｅｂｐをそれぞれ算出する。
　例えば、図３に示す２軸ロボットにおいて、第１軸の動力学トルクτ１（ｔ）及び第２軸の動力学トルクτ２（ｔ）は、それぞれ式（２１）、（２２）で表わされる。
　τ１（ｔ）＝（Ｈ１１・α１＋Ｈ１２・α２）＋（Ｄ１１・ω１＋ｂ１）＋ｃ１　・・・（２１）
　τ２（ｔ）＝（Ｈ２１・α１＋Ｈ２２・α２）＋（Ｄ２２・ω２＋ｂ２）＋ｃ２　・・・（２２）
　なお、慣性行列Ｈ１１～Ｈ２２は以下の式（２３）～（２６）で表わされる。
　Ｈ１１＝ｍ１・ｌｇ１２＋ｍ２・Ｌ１２＋ｍ２・ｌｇ２２＋Ｉ１＋Ｉ２＋２・ｍ２・Ｌ１・ｌｇ２・ｃｏｓθ２＋Ｊｍ１　・・・（２３）
　Ｈ１２＝ｍ２・ｌｇ２２＋Ｉ２＋ｍ２・Ｌ１・ｌｇ２・ｃｏｓθ２　・・・（２４）
　Ｈ２１＝ｍ２・ｌｇ２２＋Ｉ２＋ｍ２・Ｌ１・ｌｇ２・ｃｏｓθ２　・・・（２５）
　Ｈ２２＝ｍ２・ｌｇ２２＋Ｉ２＋Ｊｍ２　・・・（２６）
　また、粘性行列Ｄ１１，Ｄ２２は式（２７）、（２８）で表わされる。
　Ｄ１１＝ｄ１　・・・（２７）
　Ｄ２２＝ｄ２　・・・（２８）
　また、速度依存項トルクであるｂ１，ｂ２はそれぞれ式（２９）、（３０）で表わされる。
　ｂ１＝－ｍ２・Ｌ１・ｌｇ２・（２・ω１＋ω２）・ω２・ｓｉｎθ２　・・・（２９）
　ｂ２＝ｍ２・Ｌ１・ｌｇ２・ω１２・ｓｉｎθ２　・・・（３０）
　また、重力項トルクに対応するｃ１，ｃ２はそれぞれ式（３１）、（３２）で表わされる。
　ｃ１＝（ｍ１・ｇ・ｌｇ１＋ｍ２・ｇ・Ｌ１）ｃｏｓθ１＋ｍ２・ｇ・ｌｇ２・ｃｏｓ（θ１＋θ２）　・・・（３１）
　ｃ２＝ｍ２・ｇ・ｌｇ２・ｃｏｓ（θ１＋θ２）　・・・（３２）
　ここで、式（２１）～（３２）における各符号の内容は以下の通りである。
　θ１：時刻ｔにおける第１軸の回転角（紙面における左回りを正方向とする。）
　θ２：時刻ｔにおける第２軸の回転角（紙面における左回りを正方向とする。）
　ω１：時刻ｔにおける第１軸の回転速度
　ω２：時刻ｔにおける第２軸の回転速度
　α１：時刻ｔにおける第１軸の回転加速度
　α２：時刻ｔにおける第２軸の回転加速度
　ｍ１：第１軸のリンクの重心質量
　ｍ２：第２軸のリンクの重心質量、なお、ｍ２にはリンク先端の負荷の質量が含まれる。
　ｌｇ１：第１軸の回転中心から重心位置までの距離
　ｌｇ２：第２軸の回転中心から重心位置までの距離
　Ｌ１：第１軸の回転中心から第２軸の回転中心までの距離
　Ｉ１：第１軸の、重心位置での回転軸回りの主慣性モーメント
　Ｉ２：第２軸の、重心位置での回転軸回りの主慣性モーメント
　Ｊｍ１：第１軸のモータイナーシャのアーム回転軸換算値
　Ｊｍ２：第２軸のモータイナーシャのアーム回転軸換算値
　ｄ１：第１軸の粘性摩擦係数
　ｄ２：第２軸の粘性摩擦係数
　ｇ：重力加速度
である。
　＜ＳＴＥＰ４：補正係数の算出＞
　図９は、ｊ軸における加減速時の関節角度、速度、加速度及び動力学トルクの時間変化を示す。また、図９は、補正係数γを導出するための考え方を示す模式図でもある。
　前述したように、補正処理部２２は、動力学トルク算出部２１で算出された、所定の時刻における動力学トルク、慣性項トルク及び慣性項トルク以外のトルク（速度依存項トルク、重力項トルク）に基づいて第１及び第２補正係数γａ，γｂを算出し出力する。
　具体的な第１及び第２補正係数γａ，γｂの算出手順について以下に説明する。なお、ｊ軸の出力可能な最大トルクを許容最大トルクτｊｍａｘとする。また、本実施形態では、時刻ｔａ，ｔｂの前後における重力項トルクと速度依存項トルクの変化量は、慣性項トルクの変化量に比べて十分に小さいものとする。
　まず、ｊ軸に関する許容最大トルクτｊｍａｘと、時刻ｔａにおけるｊ軸の残余トルクτｃａｐｊとを用いて、式（３３）に示すトルクτａｒｊを算出する。
　τａｒｊ＝τｊｍａｘ－τｃａｐｊ　・・・（３３）
　なお、許容最大トルτｊｍａｘの符号は時刻ｔａにおける動力学トルクτｊ（ｔａ）と同符号に合わせる。　
　次に、動力学トルク算出部２１で算出された時刻ｔａにおけるｊ軸の慣性項トルクτａｐｊとトルクτａｒｊを用いて、ｊ軸に関する補正係数γａｊを算出する。
　γａｊ＝τａｐｊ／τａｒｊ　・・・（３４）
　同様に、ｊ軸に関する許容最大トルクτｊｍａｘと、時刻ｔｂにおけるｊ軸の残余トルクτｃｂｐｊとを用いて、式（３５）に示すトルクτｂｒｊを算出する。
　τｂｒｊ＝τｊｍａｘ－τｃｂｐｊ　・・・（３５）
　なお、許容最大トルτｊｍａｘの符号は時刻ｔｂにおける動力学トルクτｊ（ｔｂ）と同符号に合わせる。　
　次に、動力学トルク算出部２１で算出された時刻ｔｂにおけるｊ軸の慣性項トルクτｂｐｊとトルクτｂｒｊを用いて、ｊ軸に関する補正係数γｂｊを計算する。
　γｂｊ＝τｂｐｊ／τｂｒｊ　・・・（３６）
　ここで、式（３３）に示すトルクτａｒｊ及び式（３５）中のトルクτｂｒｊは、ｊ軸における最大加速度での加減速回転動作を行う場合に、ｊ軸の許容最大トルクτｊｍａｘのうち利用可能なトルク（以下、利用可能トルクと呼ぶことがある。）に相当する。また、慣性項トルクτａｐｊ及びτｂｊは、ｊ軸における最大加速度での加減速回転動作を実現するのに必要なトルクである。
　従って、式（３４），（３６）に示すγａｊ，γｂｊが１以下であれば、ｊ軸は所定の最大加速度で加減速回転動作が可能となる。一方、γａｊ，γｂｊが１よりも大きければ、ｊ軸は所望の動作を実現するのに必要なトルクが足らないことを意味する。
　次に、ロボットアーム６の全関節軸について、式（３３）～（３６）により補正係数をそれぞれ算出し、加速動作中に得られた補正係数の中の最大のものを選んで、第１補正係数γａとする。また、減速動作中に得られた補正係数の中の最大のものを選んで、第２補正係数γｂとする。なお、以降の説明において、γａ，γｂを総称して補正係数γと呼ぶことがある。
　γａ＝ｍａｘ｛γａｊ｝　・・・（３７）
　γｂ＝ｍａｘ｛γｂｊ｝　・・・（３８）
　＜ＳＴＥＰ５：加減速時間の補正＞
　演算部２３は、加減速時間算出部９で算出された加速時間Ｔａに対して、補正処理部２２で算出された第１補正係数γａを乗じて、補正後の加速時間Ｔａ’を求め、加減速処理部４に出力する。また、演算部２３は、加減速時間算出部９で算出された減速時間Ｔｂに対して、補正処理部２２で算出された第２補正係数γｂを乗じて、補正後の減速時間Ｔｂ’を求め、加減速処理部４に出力する。なお、Ｔａ’、Ｔｂ’はそれぞれ式（３９）、（４０）で表わされる。
　Ｔａ’＝Ｔａ・γａ　・・・（３９）
　Ｔｂ’＝Ｔｂ・γｂ　・・・（４０）
　式（３３）～（４０）より明らかなように、γａ，γｂ≦１の場合は、いずれの関節軸においてもトルク不足は生じていないことを意味する。この場合は、第１及び第２補正係数γａ，γｂを乗じて得る補正後の加速時間Ｔａ’及び減速時間Ｔｂ’は当初の加速時間Ｔａ及び減速時間Ｔｂと同じである。
　一方、γａ，γｂ＞１の場合は、の場合は、いずれかの関節軸においてトルク不足が生じていることを意味する。そこで、当初の加速時間Ｔａをγａ（＞１）倍した新たな加速時間Ｔａ’（＞Ｔａ）で関節軸を回転させる。これは、関節軸の当初の加速度を１／γａ倍に下げる、すなわち、慣性項トルクを１／γａ倍に下げるということである。従って、第１補正係数γａにより補正されたｊ軸の動力学トルクτｊは、その許容最大トルクτｊｍａｘを超えることはない。同様に、第２補正係数γｂにより補正されたｊ軸の動力学トルクτｊは、その許容最大トルクτｊｍａｘを超えることはない。
　加減速処理部４は、この補正後の加速時間Ｔａ’または減速時間Ｔｂ’を用いて、移動指令生成部３から出力された移動指令列に対して上述した加減速処理を行う。
　［効果等］
　以上説明したように、本実施形態におけるロボット制御装置１０は、モータと該モータによって回転駆動される関節軸とを複数組有するロボットアーム６の動作を制御する。
　また、ロボット制御装置１０は、各関節軸の回転速度と回転加速度と関節角度に基づいて、各関節軸における動力学トルクをそれぞれ算出して出力する動力学トルク算出部２１と、各関節軸の回転加速度が極大及び極小となる時点ｔａ，ｔｂでの各関節軸における関節角度の移動量Δθａｐ，Δθｂｐと回転速度ωａｐ，ωｂｐと回転加速度の極大値αａｐ及び極小値αｂｐとが各関節軸を加減速動作させるための加減速時間Ｔａ，Ｔｂに関連付けられて保存されたテーブル２４と、これが格納された記憶部２０と、を少なくとも備えている。
　動力学トルク算出部２１は、テーブル２４内の値に基づいて、回転加速度の極大値αａｐ及び極小値αｂｐに対応する動力学トルクを算出するとともに、回転加速度の極大値αａｐ及び極小値αｂｐに対応する慣性項トルクτａｐ，τｂｐと、動力学トルクから慣性項トルクを差し引いた残余トルクτｃａｐ，τｃｂｐとを算出し、各関節軸のうち少なくとも１つの関節軸において、慣性項トルクτａｐが各関節軸を所定の加速度で加減速動作させるに利用可能な利用可能トルク（τｍａｘ－τｃａｐ）よりも大きいか、慣性項トルクτｂｐが各関節軸を所定の加速度で加減速動作させるに利用可能な利用可能トルク（τｍａｘ－τｃｂｐ）よりも大きい場合は、各関節軸の回転動作における共通の加減速時間ＴａまたはＴｂを補正する。
　本実施形態によれば、多関節ロボットにおいて、各関節軸での加減速に必要なトルクが不足しているかどうかを予め検知でき、トルクが不足している場合は、加速時間Ｔａまたは減速時間Ｔｂを補正して、出力可能な範囲内のトルクで関節軸の回転動作を加速して、ロボットアーム６の動作を制御することができる。このことにより、ロボットの動作プログラム１の教示修正の手間を省くことができる。
　また、ロボット制御装置１０は、ロボットアーム６における隣り合う作業点間距離Ｌと目標移動速度Ｖとに基づいて、各関節軸に対する移動指令Δθをそれぞれ生成して出力する移動指令生成部３と、一の関節軸であるｊ軸が出力可能な許容最大トルクτｊｍａｘから残余トルクτｃａｐまたはτｃｂｐを差し引いた成分である利用可能トルクと、慣性項トルクτａｐ，τｂｐとのトルク比を算出し、さらに各関節軸における当該トルク比をそれぞれ算出して、各関節軸におけるトルク比の中の最大値を補正係数γとして出力する補正処理部２２と、を備えている。また、ロボット制御装置１０は、補正係数γが１以下の場合は、予め設定された加速時間Ｔａまたは減速時間Ｔｂに基づいて移動指令Δθを加減速処理し、補正係数γが１を超える場合は、加速時間Ｔａまたは減速時間Ｔｂに補正係数γを乗じて補正された加速時間Ｔａ’または減速時間Ｔｂ’に基づいて移動指令Δθを加減速処理する加減速処理部４と、を備えている。
　加減速処理部４で加減速処理された移動指令Δθに基づいて各関節軸を回転駆動させてロボットアーム６の動作を制御する。
　本実施形態によれば、多関節ロボットにおいて、各関節軸での加速に必要なトルクが不足しているかどうかを予め検知でき、トルクが不足している場合は、不足分に応じた値である第１補正係数γａ（＞１）で加速時間Ｔａを補正して、加速時間Ｔａを当初の値よりも大きな時間Ｔａ’とすることで、出力可能な範囲内のトルクで関節軸の回転動作を加速して、ロボットアーム６の動作を制御することができる。このことにより、ロボットの動作プログラム１の教示修正の手間を省くことができる。同様に、トルクの不足分に応じた値である第２補正係数γｂ（＞１）で減速時間Ｔｂを補正して、減速時間Ｔｂを当初の値よりも大きな時間Ｔｂ’とすることで、出力可能な範囲内のトルクで関節軸の回転動作を減速して、ロボットアーム６の動作を制御することができる。このことにより、ロボットの動作プログラム１の教示修正の手間を省くことができる。
　また、実際の加速度が極大または極小となる時刻、つまり、関節軸での加減速動作が最も急激に行われる時刻での動力学トルクに基づいて、加速時間Ｔａ及び／または減速時間Ｔｂを補正するため、ロボットアーム６を安定して動作させつつ、ロボットアーム６の動作時間であるタクトが増加するのを抑えることができる。
　テーブル２４に保存された値は、移動指令に基づいて算出されるようにしてもよい。
　このようにすることで、テーブル２４の作成作業が簡素化されるとともに、作成時間を短縮することができる。
　なお、本実施形態では、加減速プロファイルを台形形状としたが、これ以外のプロファイルに対しても適用できることは言うまでもない。
　本発明のロボット制御装置は、タクトの増加を抑制しつつ、ロボットアームを移動させる際に各関節軸で必要なトルクがその出力可能トルクを超えないように、加減速時間を自動調整することができて、ロボットの動作プログラムの教示修正を少なくし、教示作業を効率的に行うことができて、複数軸からなるロボットに適用する上できわめて有用である。
　　１　　動作プログラム
　　２　　処理部
　　３　　移動指令生成部
　　４　　加減速処理部
　　５　　サーボ
　　６　　ロボットアーム
　　７　　移動時間算出部
　　８　　各軸速度算出部
　　９　　加減速時間算出部
　　１０　ロボット制御装置
　　２０　記憶部
　　２１　動力学トルク算出部
　　２２　補正処理部
　　２３　演算部
　　２４　テーブル

Claims (3)

  1. 　モータと該モータによって回転駆動される関節軸とを複数組有するロボットアームの動作を制御するロボット制御装置であって、
    　各関節軸の回転速度と回転加速度と関節角度に基づいて、各関節軸における動力学トルクをそれぞれ算出して出力する動力学トルク算出部と、
    　各関節軸の回転加速度が極大及び極小となる時点での各関節軸における関節角度の移動量と回転速度と前記回転加速度の極大値及び極小値とが各関節軸を加減速動作させるための加減速時間に関連付けられたテーブルを有する記憶部と、を少なくとも備え、
    　前記動力学トルク算出部は、前記テーブル内の値に基づいて、前記回転加速度の極大値及び極小値に対応する動力学トルクを算出するとともに、前記回転加速度の極大値及び極小値に対応する慣性項トルクと、前記動力学トルクから前記慣性項トルクを差し引いた残余トルクとを算出し、
    　各関節軸のうち少なくとも１つの関節軸において、前記慣性項トルクが各関節軸を所定の加速度で加減速動作させるに利用可能な利用可能トルクよりも大きい場合は、各関節軸の回転動作における共通の加減速時間を補正することを特徴とするロボット制御装置。
  2. 　請求項１に記載のロボット制御装置において、
    　前記ロボットアームにおける隣り合う作業点間距離と目標移動速度とに基づいて、各関節軸に対する移動指令をそれぞれ生成して出力する移動指令生成部と、
    　一の前記関節軸が出力可能な許容最大トルクから前記残余トルクを差し引いた成分である前記利用可能トルクと、前記慣性項トルクとのトルク比を算出し、さらに各関節軸における当該トルク比をそれぞれ算出して、各関節軸における前記トルク比の中の最大値を補正係数として出力する補正処理部と、
    　前記補正係数が１以下の場合は、予め設定された前記加減速時間に基づいて前記移動指令を加減速処理し、前記補正係数が１を超える場合は、前記加減速時間に前記補正係数を乗じて補正された加減速時間に基づいて前記移動指令を加減速処理する加減速処理部と、をさらに備え、
    　前記加減速処理部で加減速処理された前記移動指令に基づいて各関節軸を回転駆動させて前記ロボットアームの動作を制御することを特徴とするロボット制御装置。
  3. 　請求項１または２に記載のロボット制御装置において、
    　前記テーブルに保存された値は、移動指令に基づいて算出されることを特徴とするロボット制御装置。
PCT/JP2019/005302 2018-05-10 2019-02-14 ロボット制御装置 Ceased WO2019215980A1 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2020518145A JP7126222B2 (ja) 2018-05-10 2019-02-14 ロボット制御装置

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2018-091668 2018-05-10
JP2018091668 2018-05-10

Publications (1)

Publication Number Publication Date
WO2019215980A1 true WO2019215980A1 (ja) 2019-11-14

Family

ID=68467986

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/005302 Ceased WO2019215980A1 (ja) 2018-05-10 2019-02-14 ロボット制御装置

Country Status (2)

Country Link
JP (1) JP7126222B2 (ja)
WO (1) WO2019215980A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115702064A (zh) * 2020-07-08 2023-02-14 三菱电机株式会社 机器人控制装置、机器人控制方法及机器人控制程序

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0580833A (ja) * 1991-09-18 1993-04-02 Mitsubishi Electric Corp 産業用ロボツトの制御装置
JPH07200033A (ja) * 1993-12-28 1995-08-04 Mitsubishi Electric Corp ロボット制御装置
JPH11259108A (ja) * 1998-03-13 1999-09-24 Mitsubishi Electric Corp ロボット制御装置
JP2007279899A (ja) * 2006-04-04 2007-10-25 Mitsubishi Electric Corp 数値制御装置
JP2009028851A (ja) * 2007-07-27 2009-02-12 Nachi Fujikoshi Corp ロボット制御装置

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0580833A (ja) * 1991-09-18 1993-04-02 Mitsubishi Electric Corp 産業用ロボツトの制御装置
JPH07200033A (ja) * 1993-12-28 1995-08-04 Mitsubishi Electric Corp ロボット制御装置
JPH11259108A (ja) * 1998-03-13 1999-09-24 Mitsubishi Electric Corp ロボット制御装置
JP2007279899A (ja) * 2006-04-04 2007-10-25 Mitsubishi Electric Corp 数値制御装置
JP2009028851A (ja) * 2007-07-27 2009-02-12 Nachi Fujikoshi Corp ロボット制御装置

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115702064A (zh) * 2020-07-08 2023-02-14 三菱电机株式会社 机器人控制装置、机器人控制方法及机器人控制程序

Also Published As

Publication number Publication date
JPWO2019215980A1 (ja) 2021-05-20
JP7126222B2 (ja) 2022-08-26

Similar Documents

Publication Publication Date Title
JP7199178B2 (ja) ロボット制御装置、ロボット装置、ロボット制御のパラメータ調整方法、およびプログラム
JP4281696B2 (ja) 加減速制御方法及び装置並びに加減速制御方法のプログラム
US9505074B2 (en) Weaving control device for articulated robot
CN110076773B (zh) 机器人设备、制造物品的方法及电机驱动设备
JP2001296912A (ja) モータの速度・加速度決定方法、加減速生成方法、加減速制御方法、加減速制御装置及びモータ制御装置
US12049011B2 (en) Robot control device, robot control method, and recording medium storing robot control program
WO2013140679A1 (ja) 軌跡制御装置
JP7170181B2 (ja) ロボット制御装置
JPH10329063A (ja) ロボット制御装置
JP4192780B2 (ja) ロボットの制御装置
US20150051735A1 (en) Control apparatus of robot, robot, and program thereof
JP2020015124A (ja) ロボット制御方法、物品の製造方法、ロボット制御装置、ロボット、プログラム及び記録媒体
JP4498061B2 (ja) 溶接ロボット制御装置
JP7126222B2 (ja) ロボット制御装置
JP2005052913A (ja) ロボット制御装置
JP2010269385A (ja) Ｓ字加減速軌道生成方法および多関節型ロボットシステム
JP6021478B2 (ja) ロボット制御装置、及びロボット制御方法
JP2016177513A (ja) タンデム位置制御装置
JPWO2018061283A1 (ja) ロボットの制御方法及び溶接方法
JP2016005296A (ja) モータ駆動装置の制御方法、モータ駆動装置及びロボット装置
JP5633268B2 (ja) ロボットの制御装置
JPH0276692A (ja) ロボットの適応制御方法
JPH0760667A (ja) ロボットのウィービング制御装置
JP3194829B2 (ja) ロボットの動作プログラム生成装置
JP6915470B2 (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: 19799997

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2020518145

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19799997

Country of ref document: EP

Kind code of ref document: A1