Robot controlling method and apparatus
AssigneeMitsubishi Denki Kabushiki Kaisha
InventorAtsushi Itoh
Life of this patent
Estimating the term…
Abstract
A multi-axis robot and controller therefor which is responsive to the input of target position information for each of plural axes and outputs position commands to motors for each axis of the robot. All of the axes are considered together and are assumed to move according to the same velocity profile, the fastest velocity is identified and used as the basis for assigning a relative load factor to each axis. An actual velocity command for movement of each axis according to the input target position is calculated on the basis of the preceeding position command, its load factor, velocity profile and interpolated velocity value. The position command is calculated on the basis of the velocity command. The controlled axes may include additional outside axes and the load factor may be variable.
Claims12
A robot controlling apparatus including position controlling means that output a series of position commands for each axis of a robot according to an input of target position information for each said axis, said position controlling means comprising:
- axis load factor calculating means for finding a maximum value of a maximum permissible velocity of each said axis as a maximum velocity character and calculating a ratio of the maximum permissible velocity of each said axis to the maximum velocity character as a load factor of each said axis;
- permissible interpolation travel velocity calculating means for calculating a permissible interpolation travel velocity from the maximum velocity character and an override factor;
- travel value calculating means for calculating a travel value of each said axis from a difference between the target position information and a preceding one of the series of position commands of each said axis;
- velocity command calculating means for finding a travel distance of each said axis as a product of the travel value and the load factor of each said axis, defining a maximum value of the travel distance as a typical travel distance, calculating a travel velocity character in at least one of an acceleration region, a constant-velocity region or a deceleration region common to each said axis on the bases of an acceleration velocity, the permissible interpolation travel velocity and a deceleration velocity, and calculating a velocity command for each said axis from a ratio of a product of the travel velocity character and the travel value of each said axis to the typical travel distance;
- position command calculating means for calculating a position command for each said axis from the velocity command for each said axis;
- and control means for controlling each said axis of said robot based on the position command for each said axis.
A method of controlling a robot having a plurality of movement axes comprising the steps of:
- inputting target position information for each of a first plurality of said movement axes;
- calculating a maximum value of a maximum permissible velocity of each of said first plurality of said movement axes as a maximum velocity character;
- calculating a ratio of the maximum permissible velocity of each of said first plurality of said movement axes to the maximum velocity character as a load factor of each of said first plurality of said movement axes;
- calculating a permissible interpolation travel velocity from the maximum velocity character and an override factor;
- calculating a travel value of each of said first plurality of said movement axes from a difference between the target position information and a previously calculated position command of each of said first plurality of said movement axes;
- determining travel distance of each of said first plurality of said movement axes as a product of the travel value and the load factor of each of said first plurality of said movement axes;
- defining a maximum value of the travel distance as a typical travel distance;
- calculating a travel velocity character in at least one of an acceleration region, a constant-velocity region and a deceleration region common to each of said first plurality of said movement axes from an acceleration velocity and a deceleration velocity common to each of said movement axes and the permissible interpolation travel velocity;
- calculating a velocity command for each of said first plurality of said movement axes from a ratio of a product of the travel velocity character and the travel value of each of said first plurality of said movement axes to the typical travel distance;
- calculating a position command for each of said first plurality of said movement axes from the velocity command for each of said first plurality of said movement axes;
- outputting the position command for each of said first plurality of said movement axes according to the input target position information;
- and controlling the robot based on the position command for each of said first plurality of said movement axes.
A method of controlling a robot system comprising a robot having a plurality of movement axes and a position controlling means for outputting position commands for each said movement axis of said robot according to an input of target position information for each said movement axis, said method comprising the steps of:
- selecting one of a first plurality of said movement axes having a maximum velocity;
- defining velocities of a second plurality of said movement axes with respect to the maximum velocity;
- calculating a maximum value of a maximum permissible velocity of each of said first plurality of said movement axes as a maximum velocity character;
- calculating a ratio of the maximum permissible velocity of each of said first plurality of said movement axes tot he maximum velocity character as a load factor of each of said first plurality of said movement axes;
- calculating a permissible interpolation travel velocity from the maximum velocity character;
- calculating a travel value of each of said first plurality of said movement axes from a difference between the target position information and a previously calculated position command of each of said first plurality of said movement axes of said robot;
- determining a travel distance of each of said first plurality of said movement axes as a product of the travel value and the load factor of each of said first plurality of said movement axes of said robot;
- defining a maximum value of the travel distance as a typical travel distance;
- calculating a travel velocity character in at least one of an acceleration region, a constant-velocity region and a deceleration region common to each of said first plurality of said movement axes from an acceleration velocity and a deceleration velocity common to each of said movement axes of said robot and the permissible interpolation travel velocity;
- calculating a velocity command for each of said first plurality of said movement axes from a ratio of a product of the travel velocity character and the travel value of each of said first plurality of said movement axes of said robot to the typical travel distance;
- calculating a position command for each of said first plurality of said movement axes from the velocity command for each of said first plurality of said movement axes of said robot;
- outputting the position command for each of said first plurality of said movement axes according to the input target position information;
- and controlling each of said first plurality of said movement axes of said robot based on the position command for each of said fist plurality of said movement axes.
Dependencies are inferred from the claim text.