摘要 |
PURPOSE:To realize positioning in which no vibration is generated, by setting a targeted position pattern so that the change of the acceleration of a mobile body becomes a smooth pattern without a discontinuous point, and performing the position control of the mobile body so as to follow the pattern. CONSTITUTION:A position feedback loop 11 calculates a difference between the present location c(t) of the mobile body for a targeted position P(t) as a position deviation e(t) at a position deviation arithmetic part 13, and supplies it to a proportional element 14 and an integral element 15. A speed feedback loop 12 sets the present speed v(t) with an element 16 as the present speed output d3. Those deviations are calculated at data arithmetic parts 17 and 18, and the speed v(t) is calculated through a gain element 19 and blocks 20 and 21, and the present location c(t) at a block 22. The targeted position P(t) is supplied to the arithmetic part 13 by varying it along a targeted position pattern PT0. In such a way, the mobile body is controlled so as to follow the pattern PT0, and is moved without generating the vibration, and also, it is positioned.
|