Trajectory control device
AssigneeSMC Corporation
InventorsShinji Wakisaka, Kazuyuki Oguma, Hikaru Yasuda
Life of this patent
Estimating the term…
Abstract
A trajectory control device includes: a contact sensor that can contact side surfaces of a workpiece; an actuator that moves a trajectory tracking member and the contact sensor; and a trajectory controller that calculates XY coordinates of a trajectory on the workpiece that is placed in an arbitrary position, by transforming XY coordinates of the trajectory on the workpiece in a reference position, based on positional information about the side surfaces of the workpiece in the reference position and positional information about the side surfaces of the workpiece placed in the arbitrary position. The positional information about the side surfaces of the workpiece placed in the arbitrary position is obtained by the contact sensor.
Claims7
A trajectory control device for moving a trajectory tracking member along a trajectory on a workpiece that is placed in an arbitrary position, the trajectory control device comprising:
- a contact sensor configured to contact side surfaces of the workpiece;
- an actuator configured to move the trajectory tracking member and the contact sensor;
- and
- a trajectory controller configured to calculate XY coordinates of the trajectory on the workpiece placed in the arbitrary position, by transforming XY coordinates of the trajectory on the workpiece in a reference position, based on positional information about the side surfaces of the workpiece in the reference position and positional information about the side surfaces of the workpiece placed in the arbitrary position, wherein
- the positional information about the side surfaces of the workpiece placed in the arbitrary position is obtained by the contact sensor,
- wherein the trajectory controller detects XY coordinates of two contact points on one side surface of the workpiece by driving the actuator to advance the contact sensor in two movement directions that are parallel to an X axis, and detects XY coordinates of two contact points on another side surface of the workpiece by driving the actuator to advance the contact sensor in two movement directions that are parallel to a Y axis, and
- wherein the trajectory controller obtains an equation of a first straight line that passes through the two contact points on the one side surface of the workpiece and an equation of a second straight line that passes through the two contact points on the another side surface of the workpiece, further obtains XY coordinates of an intersection of the first straight line and the second straight line, then calculates an amount of movement of an X coordinate and an amount of movement of a Y coordinate of a reference point of the workpiece, and also calculates a gradient angle of the another side surface of the workpiece with respect to the reference position of the workpiece.
Dependencies are inferred from the claim text.