Back to results
US 10,310,465 B2Granted
Device and method for moving an object
AssigneeRobert Bosch GmbH
InventorWalrick Dirkx
Life of this patent
Estimating the term…
Abstract
A device and method for the generation of a constraint-based, preferably time-optimal motion profile is presented. The device 100 comprises a control unit 102, said control unit 102 is configured to control a mechanical system 104, whereas an alike comprised set-point generator 101 delivers set points for the control unit 102. A moving average filter 111 is coupled to said generator 101. By application of the moving average filter 111 a piecewise constant set point profile changes into a piecewise linear profile. This has several positive effects as explained in the disclosure, while a moving object is driven via the mechanism.
Claims14
A device for moving an object, comprising:
- a first drive operably connected to the object for moving the object;
- and
- a control unit operably connected to the first drive and including a first input that receives an error signal corresponding to a sum of a position set point profile from a generator and a position feedback signal from the first drive, a second input that receives a feed forward output signal, and a control unit output;
- a feed forward control with an input that receives a feed forward input signal from the generator and an output coupled to the second input of the control unit, the feed forward control being configured to generate the feed forward output signal corresponding to at least one set point profile received from the generator;
- and
- the generator having a first output configured to generate the set point profile for the error signal of the first input of the control unit and a second output coupled to the input of the feed forward control, the generator further comprising:
- a set point generator, the set point generator being configured to generate a piecewise constant set point profile output corresponding to a third-order jerk of the object as a function of time based on a target position for the object;
- a filter structure having an input that receives the set point profile output of the set point generator, the filter structure being configured to generate a set point profile corresponding to a fourth-order snap of the object as a function of time;
- a first integration stage having an input that receives the set point profile generated by the filter structure, the first integration stage being configured to generate a set point profile corresponding to a piecewise-linear representation of the third-order jerk of the object as a function of time through the second output coupled to the feed forward control;
- a second integration stage having an input that receives the set point profile generated by the first integration stage, the second integration stage being configured to generate a set point profile output corresponding to a plurality of polynomial segments of order <=2 representation of a second-order acceleration of the object as a function of time;
- a third integration stage having an input that receives the set point profile generated by the second integration stage, the third integration stage being configured to generate a set point profile output corresponding to a plurality of polynomial segments of order <=3 representation of a first-order velocity of the object as a function of time;
- and
- a fourth integration stage having an input that receives the set point profile generated by the third integration stage, the fourth integration stage being configured to generate a set point profile output corresponding to a plurality of polynomial segments of order <=4 representation of a zero-order position of the object as a function of time through the first output,
- wherein the control unit is configured to generate a control unit output signal at the control unit output that is based on the feed forward output signal and the error signal, and
- wherein the control unit is configured to perform motion control of the object by supplying the control unit output signal to the first drive, such that the first drive moves the object with increased control performance.
12 more elements
A method for performing motion control of an object with a motion control device including a generator, the method comprising:
- receiving, with the generator, at least one motion constraint;
- receiving, with the generator, at least one target motion value indicating a target state of a position of the object as a function of time;
- generating, with a set point generator, a piecewise constant set point profile output corresponding to a third-order jerk of the object as a function of time based on the at least one target motion value;
- filtering, with a filter structure having an input coupled to the set point generator, the set point profile output from the set point generator to generate set point profile corresponding to a fourth-order snap of the object as a function of time;
- generating, with a first integration stage having an input that receives the set point profile generated by the filter structure, a set point profile corresponding to a piecewise-linear representation of the third-order jerk of the object as a function of time through a first output coupled to a feed forward control that generates a feed forward signal;
- generating, with a second integration stage having an input that receives the set point profile generated by the first integration stage, a set point profile output corresponding to a plurality of polynomial segments of order <=2 representation of a second-order acceleration of the object as a function of time;
- generating, with a third integration stage having an input that receives the set point profile generated by the second integration stage, a set point profile output corresponding to a plurality of polynomial segments of order <=3 representation of a first-order velocity of the object as a function of time;
- and
- generating, with a fourth integration stage having an input that receives the set point profile generated by the third integration stage, a set point profile output corresponding to a plurality of polynomial segments of order <=4 representation of a zero-order position of the object as a function of time through a second output coupled to a control unit,
- generating with the control unit a control unit output signal that is based on the set point profile from the fourth integration stage and the feed forward signal of the feed forward control, and
- performing motion control of the object with the control unit by supplying the control unit output signal to a drive unit configured to move the object with increased control performance.
8 more elements
A device for moving an object, comprising:
- a first drive operably connected to the object for moving the object;
- and
- a control unit operably connected to the first drive and including a first input that receives an error signal corresponding to a sum of a velocity set point profile from a generator and a velocity feedback signal from the first drive, a second input that receives a feed forward output signal, and a control unit output;
- a feed forward control with an input that receives a feed forward signal from the generator and an output coupled to the second input of the control unit, the feed forward control being configured to generate a feed forward output signal corresponding to at least one set point profile received from the generator;
- and
- the generator having a first output configured to generate the set point profile for the error signal of the first input of the control unit and a second output coupled to the input of the feed forward control, the generator further comprising:
- a set point generator, the set point generator being configured to generate a piecewise constant set point profile output corresponding to a third-order jerk of the object as a function of time based a target velocity for the object;
- a filter structure having an input that receives the set point profile output of the set point generator, the filter structure being configured to generate a set point profile corresponding to a fourth-order snap of the object as a function of time;
- a first integration stage having an input that receives the set point profile generated by the filter structure, the first integration stage being configured to generate a set point profile corresponding to a piecewise-linear representation of the third-order jerk of the object as a function of time through the second output coupled to the feed forward control;
- a second integration stage having an input that receives the set point profile generated by the first integration stage, the second integration stage being configured to generate a set point profile output corresponding to a plurality of polynomial segments of order <=2 representation of a second-order acceleration of the object as a function of time;
- a third integration stage having an input that receives the set point profile generated by the second integration stage, the third integration stage being configured to generate a set point profile output corresponding to a plurality of polynomial segments of order <=3 representation of a first-order velocity of the object as a function of time through the first output,
- wherein the control unit is configured to generate a control unit output signal at the control unit output that is based on the error signal and the feed forward output signal, and
- wherein the control unit is configured to perform motion control of the object by supplying the control unit output signal to the first drive, such that the first drive moves the object with increased control performance.
10 more elements
Dependencies are inferred from the claim text.