TRAJECTORY CONTROL DEVICE
First Claim
1. A trajectory control device in which a movable portion of a machine is driven by a plurality of movable axes, and a trajectory of the movable portion is controlled by simultaneously controlling motors of the movable axes, the trajectory control device comprising:
- a servo-system response-trajectory calculation unit that computes a servo-system response trajectory based on a position command of each movable axis;
a shape-feature determination unit that determines whether a shape of a commanded path is a straight line or a curved line based on the position command and outputs, as a feature amount of the shape of the commanded path, a shape feature amount including a boundary point position of the shape of the commanded path and a running direction of the shape near the boundary point;
a position-vector correction unit that corrects a position command by performing vector computations based on the position command, the servo-system response trajectory and the shape feature amount, and outputs a corrected position command; and
a plurality of servo control units that control a motor of each movable axis by outputting a motor drive torque so that a position of each movable axis follows the corrected position command.
1 Assignment
0 Petitions
Accused Products
Abstract
A trajectory control device controlling a trajectory of a movable portion includes a servo-system response-trajectory calculation unit that computes a servo-system response trajectory based on a position command of each movable axis, a shape-feature determination unit that outputs a shape feature amount including information of a position of a boundary point in a path shape and a running direction near the boundary point based on a determination from the position command whether the shape of the commanded path is straight or curved line, a position-vector correction unit that corrects a position vector based on the position command, the servo-system response trajectory and the shape feature amount, and outputs a corrected position command, and servo control units that control a motor of each movable axis by outputting a motor drive torque so that a position of each movable axis follows the corrected position command.
33 Citations
7 Claims
-
1. A trajectory control device in which a movable portion of a machine is driven by a plurality of movable axes, and a trajectory of the movable portion is controlled by simultaneously controlling motors of the movable axes, the trajectory control device comprising:
-
a servo-system response-trajectory calculation unit that computes a servo-system response trajectory based on a position command of each movable axis; a shape-feature determination unit that determines whether a shape of a commanded path is a straight line or a curved line based on the position command and outputs, as a feature amount of the shape of the commanded path, a shape feature amount including a boundary point position of the shape of the commanded path and a running direction of the shape near the boundary point; a position-vector correction unit that corrects a position command by performing vector computations based on the position command, the servo-system response trajectory and the shape feature amount, and outputs a corrected position command; and a plurality of servo control units that control a motor of each movable axis by outputting a motor drive torque so that a position of each movable axis follows the corrected position command. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
Specification