CN101939711A - System and method for jerk limited trajectory planning for a path planner - Google Patents
System and method for jerk limited trajectory planning for a path planner Download PDFInfo
- Publication number
- CN101939711A CN101939711A CN200880113417.1A CN200880113417A CN101939711A CN 101939711 A CN101939711 A CN 101939711A CN 200880113417 A CN200880113417 A CN 200880113417A CN 101939711 A CN101939711 A CN 101939711A
- Authority
- CN
- China
- Prior art keywords
- value
- acceleration
- acceleration value
- phase
- sampling period
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 23
- 230000036461 convulsion Effects 0.000 title abstract 2
- 230000033001 locomotion Effects 0.000 claims abstract description 54
- 230000001133 acceleration Effects 0.000 claims description 206
- 238000005070 sampling Methods 0.000 claims description 50
- 238000012545 processing Methods 0.000 claims description 3
- 230000005540 biological transmission Effects 0.000 claims 1
- 230000037361 pathway Effects 0.000 description 13
- 238000006073 displacement reaction Methods 0.000 description 12
- 238000004422 calculation algorithm Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000007634 remodeling Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012856 packing Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/416—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control of velocity, acceleration or deceleration
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41408—Control of jerk, change of acceleration
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/43—Speed, acceleration, deceleration control ADC
- G05B2219/43168—Motion profile planning for point to point control
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
- Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10S388/00—Electricity: motor control systems
- Y10S388/90—Specific system operational feature
- Y10S388/904—Stored velocity profile
Abstract
A system for generating a motion profile in real time includes a processor. The processor breaks a move into a first phase and a second phase. The first phase includes commanding the move toward a constant velocity segment, and the second phase comprises calculating a jerk value required to successfully reach end conditions during a move in progress. The processor also transmits command signals based upon the motion profile and calculates the point at which the second phase must take control to reach a target position. The system further includes a device being controlled for a move and at least one input/output module that receives command signals. A method for generating a motion profile in real time is also presented.
Description
Technical field
Theme disclosed herein is broadly directed to automatic motion controller, relates more specifically to the limited trajectory planning of acceleration.
Background technology
Path planning apparatus or path generating apparatus generally include motion controller.Path planning apparatus is used for controlling to be needed movable mechanical apparatus and determines moving of controlled member in the plant equipment.Adopt the plant equipment of path planning to be used for various industrial systems, such as making, assemble, packing and other ability.For example, servo motor is a kind of of this type of device.Moving of the element of other motor may command such as drill bit or mechanical arm.
The path generating apparatus uses various motion path algorithms and discrete time controller that path profile (path profile) is provided.Path profile is based on specific kinematic parameter.Specific kinematic parameter can comprise with the input of issuing orders: final position, maximal rate, peak acceleration, maximum deceleration and order acceleration.The starting condition that moves is determined by the original state of path planning apparatus, so initial position, initial velocity, initial acceleration and initial acceleration also are known values.
Acceleration is defined as the rate of change or the acceleration slope of acceleration.Therefore, acceleration is the derivative of acceleration and is an important variable in many application that need smooth start.The equation of motion that generates the constant acceleration path from the initial position to the final position according to acceleration, retarded velocity and constraint of velocity is well-known.Therefore, the above-mentioned known value and the equation of motion form system of equations, and this system of equations can be solved to obtain required track subsequently.
Can before carrying out any motion, solve the relevant equation of motion based on known/known variables.This method can access really and separate, but it need be not suitable for the complicated calculations of executed in real time.In addition, in many cases, complicated separating causes obtaining closed form.
Therefore, need a kind ofly to satisfy initial and final condition and be no more than the method for the time-based profile of program limit value simultaneously, and the disaggregation that can solve in real-time controller is provided in order to generate.
Summary of the invention
According to one embodiment of the present of invention, a kind of system that is used for generating in real time motion outline comprises processor.This processor is configured to be split as phase one and subordinate phase with moving.Phase one comprises that order moves towards the constant speed section, and subordinate phase is included in to move forward into to calculate between the departure date and successfully reaches the required acceleration value of end condition.
In another embodiment of the present invention, a kind of system that is used for generating in real time motion outline comprises processor.This processor is configured to transmit the command signal based on motion outline, will move to be split as phase one and subordinate phase, and calculate subordinate phase and must take to control to arrive the point of target location.This system also comprises and is configured to receive at least one input/output module of command signal and the controlled plant that is used to move.
In another embodiment of the present invention, a kind of method that is used for generating in real time motion outline comprises and is split as phase one and subordinate phase with moving.Phase one comprises that order moves towards the constant speed section, and subordinate phase is included in to move forward into to calculate between the departure date and successfully reaches the required acceleration value of end condition.
Description of drawings
Followingly be described in detail with reference to accompanying drawing, in the accompanying drawings:
Fig. 1 is the synoptic diagram of the control system of execution route planning according to an embodiment of the invention.
Fig. 2 shows seven sections the stacked graph that is used for the basic mobile type of one embodiment of the present of invention by the control system of Fig. 1.
Fig. 3 has shown to run through seven sections the common time ruler upper pathway order and the stacked graph of time relation.
Fig. 4 has shown the common time ruler upper pathway order of the section of running through 1-3 and the stacked graph of time relation.
Fig. 5 has shown the common time ruler upper pathway order of the section of existence 2 not and 6 and the stacked graph of time relation.
Fig. 6 has shown to have the common time ruler upper pathway order of new movement directive and the stacked graph of time relation.
Fig. 7 has shown the common time ruler upper pathway order with the new movement directive that exceeds program limit value and the stacked graph of time relation.
Fig. 8 has shown the section of running through 5-7 and the not common time ruler upper pathway order of the section of existence 6 and the diagram of time relation.
Embodiment
One embodiment of the present of invention relate to a kind of system and method, and it is used to generate and can be solved and satisfy the time-based motion outline that initial and final condition is no more than program limit value simultaneously in real time.Ultimate value can be minimum value or maximal value or its combination.
Referring now to Fig. 1, show the block diagram of programmable automatic controller (PAC) the type kinematic system 1 that is used for path planning according to one embodiment of present invention.PAC system 1 comprises PAC system type motion controller 9, PAC system type motion module (PMM) optic fibre connector row 5 and (PMM) motherboard 2 of being made up of microprocessor subsystem 3.Also can use processor system.PMM motherboard 2 also comprises some subsystems that comprise path maker 4.Path maker 4 is firmware subsystems of operation on the microprocessor 3 that is specifically designed to path planning.Support other firmware subsystem of the function of PMM motherboard 2 to comprise communication bus 6, such as PCI backplane drive device, state machine, command process, command interface, servocontrol, and other relevant hardware supported function.
The PAC kinematic system also comprises PMM Servo Control Board 8.Servo Control Board 8 can be and is housed in the inner daughter board of motion-control module (PMM).For example, Servo Control Board 8 usefulness act on the motion controller of the controlled member of plant equipment such as mechanical arm.
Best Times path between initial position and the target location is the path that utilizes the order acceleration value of user program.Yet, follow the Best Times path and be not suitable for real-time application.In order to follow the Best Times path, when treatment facility must fill order acceleration value it must calculate the precise time along the path when arriving the target location.If calculate precise time, then know ideal trajectory and can follow it.Find out whole mobile precise time and need solve the calculating that in many situations, does not produce the complexity that closed form separates.
In one embodiment of the invention, processor 3 utilizes to move and is split as two stage two stage orbit generation methods.In order as far as possible closely to follow the Best Times path in real time, processor 3 uses user-specified command acceleration value till subordinate phase begins.Before any motion of order, processor 3 reaches the required acceleration value of end condition moving forward between the departure date to each sampling period calculating.Equally, moving forward between the departure date, the bid value that will be used for acceleration with calculate for the current sampling period reach that the required acceleration value of end condition compares and with calculate reach the required acceleration value of end condition for next sampling period and compare.Bid value J when acceleration
cBe positioned at the acceleration value J in the current sampling period that calculates
nAcceleration value J with next sampling period that calculates
N+1Between the time, the acceleration value of carrying out at time n is J
nThe time that the subordinate phase that Here it is moves begins.
As a result, motion outline may closely be followed the Best Times path to the greatest extent in real time and can not surpassed program limit value or exceed the input command value of user's appointment.Motion outline shows the shortest time path that arrives the known target position, and wherein retarded velocity (or acceleration) began on the sampling period.Depend on end condition, the acceleration value that reaches end condition can be represented and be decelerated to than the retarded velocity of low velocity or accelerate to the acceleration of fair speed.
Based on the motion outline that generates before moving beginning, processor 3 transmits the command signal that moves that is used to carry out between known initial position and the known target position.I/O module 7 receives command signal from processor 3.
Referring now to the stacked graph of Fig. 2, show order of common time ruler upper pathway and the time relation of using dual stage process to generate.Fig. 2 also shows wherein needs seven sections to finish mobile basic mobile type.Particularly, these seven sections comprise from three sections of the phase one, constant speed section and from three sections of subordinate phase.
In constant acceleration pattern, acceleration curve or profile 20 keep the constant command value in each section 1-3.The section start of the subordinate phase section of starting from 5 that moves.Especially, move and continue, up to order acceleration value J through constant speed section (section 4)
cAcceleration value J greater than the current sampling period that calculates
n, but less than the acceleration value J in next sampling period that calculates
N+1Till.At the section start (section 5) of subordinate phase, at time n, processor 3 is carried out J
nAs the acceleration value.
As shown in Figure 2, acceleration curve 20 has value J in the duration of sampling time n and the section of running through 5
nThe value of the acceleration of section 5,6 and 7 will always be less than or equal to bid value.In this example scenario, reach the required acceleration value of end condition and represent the retarded velocity that is decelerated to than low velocity.
In Fig. 2, accelerating curve 22 shows and runs through mobile acceleration curve 20 corresponding acceleration and reach its maximal value in section 2.Rate curve 24 shows and runs through mobile acceleration curve 20 and accelerating curve 22 corresponding speed.Speed reaches its maximal value in section 4.The displacement of controlled plant is illustrated by displacement curve 26, and it is corresponding to acceleration profile 20, acceleration profile 22 and velocity profile 24.
Two stages with constant speed section move owing to wherein all not controlled variable reach peaked point-to-point moving and obtain.Speed, acceleration and retarded velocity all reach their maximal value.Table 1 has been described each section and unique aspect thereof.
Table 1
Segment number | Describe |
1 | Utilize the acceleration of appointment to control the constant acceleration section of the increase of acceleration rate.In case reach maximum constant acceleration and acceleration vanishing section, maybe need to reduce acceleration rate to satisfy the end condition of wishing, this section just stops. |
2 | Zero acceleration/constant acceleration section, wherein constant acceleration is the maximal value of supply.Order constant acceleration when needs and reduce acceleration with the maximal rate that reaches user's appointment or when moving the required peaked value of the end condition that reaches hope, this section termination. |
3 | Utilize the acceleration of appointment to control the constant negative acceleration section that acceleration rate descends.In case acceleration and acceleration are zero and reach the maximum constant speed of appointment or satisfy and reach the required peak velocity of end condition that this section just stops. |
4 | Zero acceleration, zero acceleration and constant speed section.When the negative constant acceleration of needs order slows down when arriving the position of wishing this section termination. |
5 | Utilize the acceleration of appointment to control the constant negative acceleration section of the increase of retarded velocity rate.Become the zero end condition of retarded velocity rate with satisfied hope that maybe need to reduce in case reach constant retarded velocity and acceleration, this section just stops. |
6 | Zero acceleration, constant retarded velocity section are wherein supplied constant retarded velocity.When needs order acceleration reduces the retarded velocity rate when reaching the end condition of hope, this section stops. |
7 | Utilize the acceleration of appointment to control the constant acceleration section of the decline of retarded velocity rate.In case move the end condition that reaches hope, this section just stops. |
In one embodiment of the invention, processor 3 utilizes constant acceleration pattern to calculate motion outline.In this case, acceleration is a controlled variable, and acceleration and the speed maximal value for not being exceeded.In order to simplify path planning algorithm, processor 3 calculates in mobile carrying out and successfully satisfies the required acceleration value of end condition.This is also referred to as retarded velocity and separates.Yet, depend on end condition, reach the required acceleration value of end condition and can represent and be decelerated to than the retarded velocity of low velocity or accelerate to the acceleration of fair speed.
In this two stages orbit generation method, the phase one order is moved and is arrived the constant speed section.Subordinate phase is monitored mobile progress consistently must start the point with the final condition that arrives target location or hope to determine retarded velocity.Phase one is used for planning initial motion.Therefore, only need on the sampling period that newer command arrives, to carry out phase one calculating.The operation subordinate phase is taked to control to reach the time of end condition to determine subordinate phase.
Though wish on the initial sampling period that order is moved, not only to move the phase one but also move subordinate phase and calculate, do not do this requirement.For the Balance Treatment load, processor 3 can be divided on a plurality of sampling periods the processing that the phase one calculates and subordinate phase is calculated.Only require to move when just beginning subordinate phase on this cycle in the initial sampling period, the division of this processing just influences the path of hope.This is very small influence, and in many situations, the improvement in performance that obtains is worth it.Yet, must take moving of the point controlled because path planning apparatus must can be handled starting condition, so the extra firmware of needs through subordinate phase.
Phase one order motion arrives section 4 (constant speed sections).Processor 3 section of consideration 5-7 not in the phase one.Therefore, processor 3 utility command values are calculated moving that maximum command speed (starting point of section 4) is finished.Though this motion outline may be before subordinate phase begins can the section of arrival 4, still significantly reduced the complicacy of algorithm.
The subordinate phase monitoring phase one needs to slow down or quicken to reach the end condition of hope to determine when.Therefore, the mobile starting condition of current execution as the retarded velocity equation.Because processor only need the section of solving 5,6 and 7, so this has significantly reduced the complicacy of retarded velocity system of equations.
When uncontrolled variables and/or starting condition produce some section no longer when separating required separating time optimal, move the section that needs less than seven.Therefore, processor 3 can need not to calculate or use all sections mobile successfully to finish in the time quantum of minimum.In addition, subordinate phase can be in any time after the phase one begins, even begins in the mobile section of being in 1 time.
The input command value of acceleration, speed, acceleration and retarded velocity is appointed as absolute value by the user.Yet, the size of bid value during moving be not all be on the occasion of.Therefore, microprocessor 3 is given the input command value with correct symbol.
In order to give input value with correct symbol, processor 3 will work as precondition and command position compares.If command position is greater than initial position, then speed is being for just, and acceleration is being for just, and retarded velocity is for negative, and initial acceleration is for just.In Fig. 2, displacement curve 26 is followed the profile of command position greater than initial position.On the contrary, the stacked graph of Fig. 3 has shown the example scenario of initial position greater than the final position of displacement curve 36.Processor 3 is given bid value with opposite symbol.Therefore, speed is for negative, and acceleration is for negative, and retarded velocity is for just, and initial acceleration is for bearing.
Fig. 3 has shown the common time ruler upper pathway order and the stacked graph of time relation.In Fig. 3, need seven sections and finish mobile.Similar to Fig. 2, these seven sections comprise from three sections of the phase one, constant speed section and from three sections of subordinate phase, but in the section 1 bid value of acceleration for negative.
The starting point of the subordinate phase section of starting from 5 of Fig. 3.Especially, move and continue, up to order acceleration value J through constant speed section (section 4)
cAcceleration value J greater than the current sampling period that calculates
n, but less than the acceleration value J in next sampling period that calculates
N+1Till.At the section start (section 5) of subordinate phase, at time n, processor 3 uses J
nAs the acceleration value.
As shown in Figure 3, acceleration curve 20 has value J in the duration of sampling time n and the section of running through 5
nThe value of the acceleration of section 5,6 and 7 will always be less than or equal to bid value.In this example scenario, reach the acceleration that the required acceleration value representative of end condition accelerates to fair speed.
In Fig. 3, accelerating curve 32 shows the acceleration curve 30 corresponding acceleration of accekeration for bearing with section 1 equally.Rate curve 34 shows acceleration curve 30 and the accelerating curve 32 corresponding speed of velocity amplitude for bearing with section 1.
Example scenario among Fig. 4 is to have shown the time ruler upper pathway order common in the phase one stage casing 1-3 that moves and the stacked graph of time relation.Acceleration curve 40 keeps steady state value in each independent section.The equal and opposite in direction of the acceleration in the section 1 and 3.Accelerating curve 42 shows with acceleration curve 40 corresponding acceleration and reach its maximal value in section 2.Rate curve 24 shows in section 1-3 and acceleration curve 40 and accelerating curve 42 corresponding speed.
Illustrate as shown in Figure 4 and by curve 42, the initial acceleration value is greater than the order accekeration.Here, first of the path generating apparatus action is to be decelerated to maximum acceleration value.The situation that this symbol that has produced acceleration in the section 1 and 3 equates.
As mentioned before, can to require also to may not request all sections 1-7 successfully to finish mobile for path planning apparatus.Processor 3 determines to finish the quantity that moves required discrete time section.In the phase one, which path planning apparatus determine to need among the section 1-3.Compute segment 4, because it is regarded as the end condition of phase one.If motion outline arrives section 4, then processor 3 continues sampling as usual.When changing the acceleration value when reaching end condition, subordinate phase works.
Return with reference to the phase one, use the known equation of motion, processor 3 solves and reaches the required peak accelerator of end condition (beginning of section 4).Processor 3 compares peak accelerator and the mobile peak acceleration that is allowed.If the acceleration that peak accelerator allows less than maximum, the then section of needs 2 not.If peak accelerator then needs second section to come the peak limiting acceleration greater than the acceleration that maximum allows.
As mentioned above, before any motion of order, processor 3 is finished required the separating of mobile phase one for each sampling period calculating.In order to simplify path planning algorithm, in the phase one, processor 3 order motions arrive section 4.In the phase one, the starting point of section 4 is considered as the end condition that it moves.
In some cases, the section of needs 2 is not finished the mobile phase one.Fig. 5 shows the example scenario when the section of needs not 2.Fig. 5 has shown the common time ruler upper pathway order and the stacked graph of time relation.The motion outline of Fig. 5 comprises from two sections of the phase one, constant speed section and from two sections of subordinate phase.In Fig. 5, the section of needs 2, do not allow to reach peak acceleration because the maximal rate of curve 54 is too low to reach and to keep maximum and wish speed (section 4) before needs degree of will speed up is kept to zero.In curve 52, the acceleration that the peak accelerator that is reached allows less than maximum.
In the section 1 of accelerating curve 52, acceleration rate increases, and in section 3, acceleration rate descends.Therefore, accelerating curve 52 is followed the triangle acceleration profile from section 1-3.Accelerating curve 52 is followed triangular-shaped profile, can not surpass any constraint because shortest path carried out by processor 3.The displacement of controlled plant is illustrated by displacement curve 56, and it is corresponding to acceleration profile 50, acceleration profile 52 and velocity profile 54.
Equally as shown in Figure 5, the starting point of the subordinate phase section of starting from 5.Especially, move and continue, up to order acceleration value J through constant speed section (section 4)
cAcceleration value J greater than the current sampling period that calculates
n, but less than the acceleration value J in next sampling period that calculates
N+1Till.After subordinate phase (section 5) beginning, at time n, processor 3 uses J
nAs the acceleration value.
On the contrary, when maximal rate enough greatly consequently reaches peak acceleration, need all sections 1,2 and 3 to finish the mobile phase one.In other words, the mobile constant acceleration section (section 2) that needs reaches command speed.
In example scenario shown in Figure 6, need all three section 1,2 and 3 to finish the mobile phase one.Fig. 6 has shown the common time ruler upper pathway order and the stacked graph of time relation.In this case, abandoned by the new movement directive of user's appointment moving of carrying out.New movement directive does not exceed mobile program limit value.The displacement of controlled plant is illustrated by displacement curve 66, and it is corresponding to acceleration profile 60, acceleration profile 62 and velocity profile 64.
During the section 2 that moves, receive new input command value, it provides absolute value is 100 acceleration.In accelerating curve 62, the acceleration of this section 2 has the value greater than the newer command acceleration.Therefore, move and to be decelerated to this new peak acceleration.In addition, the mobile acceleration maximal rate limited and that reach hope that is necessary for.
New acceleration order can be found out in accelerating curve 62 and rate curve 64 influence of motion feature.Accelerating curve 62 slows down to reach new peak acceleration.Processor 3 is carried out newer command acceleration value and is experienced another section 1, thereby begins the phase one once more.This allows to move and is decelerated to new maximum acceleration value 100 from accekeration 200.Though accelerating curve 62 is in the maximum constant acceleration, rate curve 64 linearities increase to the maximal rate of hope.
In a further exemplary embodiment, processor 3 can reduce acceleration during existing moving.Can carry out and reduce maximum acceleration and make peak acceleration be changed to currency or reduce its order.In this case, move problem is arranged.In order to use this new acceleration value, require to be moved beyond maximal rate.Processor 3 can not exceed program limit value, for example, and such as maximal rate or other maximal value.
Therefore, need current acceleration value to be issued to maximal rate in the situation of not toning.Processor 3 generation warnings and the mobile the current command value that continues to use acceleration and acceleration are till acceleration is finished.At this point, processor 3 is carried out new value.
Fig. 7 is the example scenario when producing warning in the above described manner.Fig. 7 has shown the common time ruler upper pathway order and the stacked graph of time relation.And in the section 2 of acceleration curve 70, receive the acceleration value is reduced to 10 and peak acceleration reduced to 100 input from 200 from 100.Yet, use newer command acceleration value 10 need be moved beyond the maximal rate of order.In other words, the acceleration value being reduced to 10 new movement directive will not allow acceleration through reaching zero before the maximal rate.Because the speed that slows down, accelerating curve 82 will can not reach zero fast enough to reach the maximal rate of order.The maximum speed value of order is with toning, and this will exceed program limit value.Because processor 3 will can not exceed these values, so processor 3 produces warning and use original acceleration value 100 to continue to move.Correspondingly, acceleration curve 70, accelerating curve 72 and rate curve 74 use the original directive value of acceleration and acceleration to continue to move, till the starting point of section 5.
In the section 5 of mobile profile shown in Figure 7, the subordinate phase that moves begins, and 3 pairs of acceleration curves of processor 70 distribute new value 10.Accelerating curve 72 sections of running through 5 ground correspondingly slow down with new acceleration value.Rate curve 74 shows and acceleration curve 70 and accelerating curve 72 corresponding speed.In addition, the displacement of controlled plant is illustrated by displacement curve 76, and it is corresponding to acceleration profile 70, acceleration profile 72 and velocity profile 74.
When the phase one of processor 3, the order motion arrived section 4, the subordinate phase monitoring phase one needed to slow down or quicken to reach the end condition of hope to determine when.Therefore, the mobile starting condition of current execution as the retarded velocity equation.In subordinate phase, the path planning apparatus section of solving 5,6 and 7.The value of the acceleration of section 5,6 and 7 will always be less than or equal to bid value.
In subordinate phase, path planning apparatus can need also not the section of needs 6 successfully to finish mobile.At first, processor 3 is owing to the peak deceleration that there is not the limit in hypothesis is calculated in order.Processor 3 compares the peak deceleration that calculates then with the maximum retarded velocity that allows.If the retarded velocity that the peak deceleration that calculates allows less than maximum, the then section of needs 6 not.If the retarded velocity that the peak deceleration that calculates allows greater than maximum, then the section of needs 6.In this case, can use the use of the another kind of algorithm section of expression 6, it will insert constant retarded velocity section.In subordinate phase, when during less than target velocity, also calculating peak accelerator at the initial velocity of the starting point of section 5.
Fig. 8 shows when the section of needs 6 not and finishes example scenario when mobile.Fig. 8 has shown common order of time ruler upper pathway and time relation.In Fig. 8, the section of needs 6, because the retarded velocity that the peak deceleration that calculates allows less than maximum.
In the section 5 of accelerating curve 82, acceleration rate descends, and in section 7, acceleration rate increases.Therefore, accelerating curve 82 is followed the triangle retarded velocity profile from section 5-7.Accelerating curve 82 is followed triangular-shaped profile, can not surpass any constraint because shortest path carried out by processor 3.
Again, when not limiting retarded velocity, form triangular-shaped profile.Processor 3 is carried out and is being no more than the shortest retarded velocity path that produces under the situation of any constraint when retarded velocity began on the sampling period.Therefore, the triangle projectile deceleration history is followed in the path of curve 82.Alternatively, section 6 is finished mobilely if desired, and then processor 3 inserts constant retarded velocity section.
In subordinate phase, processor 3 solves and successfully satisfies the required acceleration of end condition that is used to slow down.Depend on end condition, retarded velocity is separated and may be needed to be decelerated to than the retarded velocity of low velocity or accelerate to the acceleration of fair speed.Even acceleration/retarded velocity slope is little, processor 3 also always can solve it.Yet the acceleration value must still be no more than the path profile of the minimum time of any command parameter or constraint as far as possible to allow processor 3 generation representatives to finish near bid value.Equally, subordinate phase began on the sampling period, so in the starting point of section 5, processor 3 generates and shows the success that execution calculates on the sampling period and satisfy the motion outline in the shortest time path of the required acceleration value of end condition.
Though by reducing the track that acceleration calculates will can not be ideal trajectory, bid value will can not be exceeded.Therefore, ideal trajectory is known and in the somewhere between two sampling periods.Preferably, the sampling period is short in as far as possible to improve motion control.
Again, satisfy the track that the final track of end condition needn't be slow down.Depend on mobile final condition, final track can be the track that quickens.Especially, the starting point of subordinate phase, or section 5 can be retarded velocity section or acceleration section.In addition, can accept the non-zero speed end condition.Non-zero speed end condition even can have value greater than the maximal rate that moves moves and moves the result who mixes with another because it can be one.
As described herein with shown in the accompanying drawing, the structure of path planning system and method and setting are just illustrative.Though described only some embodiment of the present invention in this disclosure in detail, but those skilled in the art will easily understand after reading present disclosure, under the prerequisite of novel teachings that does not break away from theme cited in the claim in fact and advantage, many remodeling (for example, the variation of the value of various size of component, yardstick, structure, shape and ratio, parameter, the purposes that setting, material are installed, orientation etc.) are possible.Therefore, intention is included in all these type of remodeling as in the scope of the present invention that limits in the claim.The order of any program or method step or order can change or resequence according to an alternative embodiment.In the claims, any device+function clause intention contains the structure that is described to carry out cited function in the literary composition, and not only contains equivalent structures but also contain equivalent structure.Can make other in design, the operating conditions of preferred and other exemplary embodiment with in being provided with substitutes, revises, changes and omission and do not break away from the spirit of embodiments of the invention as claimed in claim.Therefore, technical scope of the present invention is not only contained the foregoing description, and contains to fall all embodiment within the scope of the claims.
Claims (19)
1. system that is used for generating in real time motion outline, described system comprises processor, described processor is configured to:
To move and be split as phase one and subordinate phase, the described phase one comprises that order is described moves towards the constant speed section, and described subordinate phase is included in to move forward into to calculate between the departure date and successfully arrives the required acceleration value of end condition.
2. system according to claim 1 is characterized in that, described processor further is configured to:
Calculate described subordinate phase and must take to control arriving the point of target location, the point that wherein said subordinate phase must be taked to control can appear at any time of described phase one after beginning; And
Transmit command signal, be used between known initial position and described target location, carrying out and move.
3. system according to claim 1 is characterized in that, described processor further is configured to: will the processing that the phase one calculates and subordinate phase is calculated be divided on a plurality of sampling periods.
4. system according to claim 2, it is characterized in that, described processor further is configured to: be no more than the described motion outline of generation under the prerequisite of program limit value, described motion outline shows the shortest path of time that arrives described target location, wherein satisfies the required acceleration value of end condition on the sampling period with running succeeded.
5. system according to claim 2, it is characterized in that, described processor further is configured to: determine to finish the described quantity that moves required discrete time section, wherein said motion outline is included in a plurality of discrete time sections between described initial position and the described target location.
6. system according to claim 5 is characterized in that: one in described subordinate phase and the described a plurality of discrete time section begins simultaneously.
7. system according to claim 1 is characterized in that, described processor further is configured to: give the input command value with correct symbol, wherein the input command value of acceleration, speed, acceleration and retarded velocity is appointed as absolute value by the user.
8. system according to claim 4 is characterized in that, described processor further is configured to:
Abandon ongoing moving after receiving the new movement directive value of at least one user's appointment, wherein said at least one new movement directive value does not exceed described program limit value; And
Carry out described at least one newer command value and continue described moving.
9. system according to claim 4 is characterized in that, described processor further is configured to:
Produce warning after receiving the new movement directive value of at least one user's appointment, wherein said at least one new movement directive value exceeds described program limit value; And
Use the current command value to continue ongoing moving.
10. system according to claim 1 is characterized in that, described processor further is configured to:
Calculate the required acceleration value of end condition that successfully reaches the current sampling period;
Calculate the required acceleration value of end condition that successfully reaches next sampling period; And
The acceleration value that the current sampling period that calculates is required and next sampling period that calculates, required acceleration value compared with order acceleration value.
11. system according to claim 9, it is characterized in that, described processor further is configured to: when described order acceleration value is between the acceleration value in required acceleration value of the current sampling period that calculates and next sampling period of calculating, carry out required acceleration value of current sampling period of calculating to begin described mobile subordinate phase.
12. system according to claim 11 is characterized in that, carries out the required acceleration value of current sampling period that calculates in the time in current sampling period.
13. a system that is used for generating in real time motion outline, described system comprises:
Processor, described processor is configured to:
Transmission is based on the command signal of described motion outline;
To move and be split as phase one and subordinate phase;
Calculating described subordinate phase must take to control to arrive the point of target location;
Be configured to receive at least one input/output module of described command signal; And
Be used for described mobile controlled plant.
14. system according to claim 13 is characterized in that, described processor further is configured to:
Successfully arrive the required acceleration value in described target location and must take the point controlled to carry out the acceleration value that calculates moving forward into to calculate between the departure date in described subordinate phase;
Wherein, the described subordinate phase point that must take to control appeared on the sampling period; And
Wherein, the described subordinate phase point that must take to control can appear at any time of described phase one after beginning.
15. a method that is used for generating in real time motion outline, described method comprises:
To move and be split as phase one and subordinate phase, the described phase one comprises that order is described moves towards the constant speed section, and described subordinate phase is included in to move forward into to calculate between the departure date and successfully arrives the required acceleration value of end condition.
16. method according to claim 15 is characterized in that, described method also comprises:
Calculate described subordinate phase and must take to control arriving the point of target location, the point that wherein said subordinate phase must be taked to control can appear at any time of described phase one after beginning; And
Transmit command signal, be used between known initial position and described target location, carrying out and move.
17. method according to claim 16, it is characterized in that, described method also comprises: be no more than the described motion outline of generation under the prerequisite of program limit value, described motion outline shows the shortest path of time that arrives described target location, wherein runs succeeded on the sampling period and satisfies the required acceleration value of end condition.
18. method according to claim 15 is characterized in that, described method also comprises:
Calculate the required acceleration value of end condition that successfully reaches the current sampling period;
Calculate the required acceleration value of end condition that successfully reaches next sampling period; And
The acceleration value that the current sampling period that calculates is required and next sampling period that calculates, required acceleration value compared with order acceleration value.
19. method according to claim 18, it is characterized in that, described method also comprises: when described order acceleration value is between the acceleration value in required acceleration value of the current sampling period that calculates and next sampling period of calculating, carry out required acceleration value of current sampling period of calculating to begin described mobile described subordinate phase.
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US11/875913 | 2007-10-21 | ||
US11/875,913 US7919940B2 (en) | 2007-10-21 | 2007-10-21 | System and method for jerk limited trajectory planning for a path planner |
PCT/US2008/072966 WO2009055120A2 (en) | 2007-10-21 | 2008-08-13 | System and method for jerk limited trajectory planning for a path planner |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101939711A true CN101939711A (en) | 2011-01-05 |
CN101939711B CN101939711B (en) | 2013-11-20 |
Family
ID=39767086
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2008801134171A Active CN101939711B (en) | 2007-10-21 | 2008-08-13 | System and method for jerk limited trajectory planning for a path planner |
Country Status (5)
Country | Link |
---|---|
US (1) | US7919940B2 (en) |
EP (1) | EP2220544B1 (en) |
JP (1) | JP5343081B2 (en) |
CN (1) | CN101939711B (en) |
WO (1) | WO2009055120A2 (en) |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104423303A (en) * | 2013-08-28 | 2015-03-18 | 洛克威尔自动控制技术股份有限公司 | Sizing and tuning methodology for optimized motion control components and energy efficiency |
CN105388853A (en) * | 2014-08-28 | 2016-03-09 | 发那科株式会社 | numerical control device |
CN105539434A (en) * | 2014-08-29 | 2016-05-04 | 通用汽车环球科技运作有限责任公司 | Method of path planning for evasive steering maneuver |
CN108780610A (en) * | 2016-03-24 | 2018-11-09 | 本田技研工业株式会社 | For the system and method for unexpected pedestrian's planned trajectory |
CN109562929A (en) * | 2016-05-24 | 2019-04-02 | Fmc技术公司 | For the motion control apparatus of radial type fluid loading arm, its acquisition and calculation method and equipment and radial type fluid loading arm |
CN109765851A (en) * | 2019-02-15 | 2019-05-17 | 大族激光科技产业集团股份有限公司 | Speed calculation method, device, storage medium and the computer equipment of track movement |
CN110000794A (en) * | 2019-05-06 | 2019-07-12 | 江苏集萃智能制造技术研究所有限公司 | A kind of asymmetric speed planning method of clean cut system based on cooperation robot |
CN110023856A (en) * | 2017-01-10 | 2019-07-16 | 韩华泰科株式会社 | The method and computing device of motion outline are generated by using S type curve |
CN110365280A (en) * | 2018-04-03 | 2019-10-22 | 东元电机股份有限公司 | Motor control system and its method |
CN111665851A (en) * | 2020-06-30 | 2020-09-15 | 哈工大机器人(合肥)国际创新研究院 | Trajectory planning method and device for dynamically adjusting running speed of robot |
CN111750162A (en) * | 2019-03-29 | 2020-10-09 | 费斯托股份两合公司 | Trajectory planning unit, valve assembly and method |
CN112689807A (en) * | 2018-09-12 | 2021-04-20 | 西门子股份公司 | Time-optimized movement guidance between path segments |
CN113942781A (en) * | 2021-10-15 | 2022-01-18 | 西门子工厂自动化工程有限公司 | Method and apparatus for determining delivery system selection data and computer readable storage medium |
Families Citing this family (57)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8024069B2 (en) * | 2009-01-28 | 2011-09-20 | Ge Intelligent Platforms, Inc. | System and method for path planning |
DE102009023307A1 (en) * | 2009-05-29 | 2010-12-02 | Kuka Roboter Gmbh | Method and device for controlling a manipulator |
WO2011008207A1 (en) * | 2009-07-15 | 2011-01-20 | Otis Elevator Company | Energy savings with optimized motion profiles |
DE102010013526A1 (en) * | 2010-03-31 | 2011-10-06 | Weiß GmbH Sondermaschinentechnik | Method for the rotational and / or linear movement of a workpiece |
JP5146512B2 (en) * | 2010-10-13 | 2013-02-20 | オムロン株式会社 | Control device, control system, and control method |
DE102010050232A1 (en) * | 2010-10-30 | 2012-05-03 | Volkswagen Ag | Method and device for controlling a valve of an internal combustion engine |
JP5320420B2 (en) * | 2011-02-18 | 2013-10-23 | 株式会社日立ハイテクインスツルメンツ | Motor control device and motor control method |
US10185304B2 (en) | 2012-03-21 | 2019-01-22 | Delcam Limited | Timing a machine tool using an accelerometer |
GB201204908D0 (en) | 2012-03-21 | 2012-05-02 | Delcam Plc | Method and system for testing a machine tool |
JP2014233774A (en) * | 2013-05-31 | 2014-12-15 | 株式会社荏原製作所 | Robot arm control device, substrate transportation device, substrate processing device, robot arm control method and program |
US9354070B2 (en) | 2013-10-31 | 2016-05-31 | Crown Equipment Corporation | Systems, methods, and industrial vehicles for determining the visibility of features |
EP3514032B1 (en) * | 2013-12-04 | 2024-02-07 | Mobileye Vision Technologies Ltd. | Adjusting velocity of a vehicle for a curve |
JP5908544B2 (en) * | 2014-08-11 | 2016-04-26 | ファナック株式会社 | Robot program generation device for generating a robot program for reducing drive shaft jerk |
CN106575150B (en) | 2014-08-16 | 2020-03-03 | 谷歌有限责任公司 | Method for recognizing gestures using motion data and wearable computing device |
US20160155098A1 (en) | 2014-12-01 | 2016-06-02 | Uptake, LLC | Historical Health Metrics |
US10254751B2 (en) | 2015-06-05 | 2019-04-09 | Uptake Technologies, Inc. | Local analytics at an asset |
US10579750B2 (en) | 2015-06-05 | 2020-03-03 | Uptake Technologies, Inc. | Dynamic execution of predictive models |
US10176279B2 (en) | 2015-06-05 | 2019-01-08 | Uptake Technologies, Inc. | Dynamic execution of predictive models and workflows |
US10878385B2 (en) | 2015-06-19 | 2020-12-29 | Uptake Technologies, Inc. | Computer system and method for distributing execution of a predictive model |
WO2017049207A1 (en) | 2015-09-17 | 2017-03-23 | Uptake Technologies, Inc. | Computer systems and methods for sharing asset-related information between data platforms over a network |
US10623294B2 (en) | 2015-12-07 | 2020-04-14 | Uptake Technologies, Inc. | Local analytics device |
US11295217B2 (en) | 2016-01-14 | 2022-04-05 | Uptake Technologies, Inc. | Localized temporal model forecasting |
US10510006B2 (en) | 2016-03-09 | 2019-12-17 | Uptake Technologies, Inc. | Handling of predictive models based on asset location |
US10796235B2 (en) | 2016-03-25 | 2020-10-06 | Uptake Technologies, Inc. | Computer systems and methods for providing a visualization of asset event and signal data |
US9776640B1 (en) | 2016-03-30 | 2017-10-03 | Linestream Technologies | Automatic determination of maximum acceleration for motion profiles |
FR3051569A1 (en) * | 2016-05-17 | 2017-11-24 | Peugeot Citroen Automobiles Sa | METHOD AND SYSTEM FOR MONITORING AN ELECTROMAGNETIC VALVE ACTUATOR OF A THERMAL MOTOR WITH AN OPTIMIZED DAMAGE LAW |
US10333775B2 (en) | 2016-06-03 | 2019-06-25 | Uptake Technologies, Inc. | Facilitating the provisioning of a local analytics device |
US10210037B2 (en) | 2016-08-25 | 2019-02-19 | Uptake Technologies, Inc. | Interface tool for asset fault analysis |
US10474932B2 (en) | 2016-09-01 | 2019-11-12 | Uptake Technologies, Inc. | Detection of anomalies in multivariate data |
US10228925B2 (en) | 2016-12-19 | 2019-03-12 | Uptake Technologies, Inc. | Systems, devices, and methods for deploying one or more artifacts to a deployment environment |
US10579961B2 (en) | 2017-01-26 | 2020-03-03 | Uptake Technologies, Inc. | Method and system of identifying environment features for use in analyzing asset operation |
US10671039B2 (en) | 2017-05-03 | 2020-06-02 | Uptake Technologies, Inc. | Computer system and method for predicting an abnormal event at a wind turbine in a cluster |
US10255526B2 (en) | 2017-06-09 | 2019-04-09 | Uptake Technologies, Inc. | Computer system and method for classifying temporal patterns of change in images of an area |
US11232371B2 (en) | 2017-10-19 | 2022-01-25 | Uptake Technologies, Inc. | Computer system and method for detecting anomalies in multivariate data |
US10552246B1 (en) | 2017-10-24 | 2020-02-04 | Uptake Technologies, Inc. | Computer system and method for handling non-communicative assets |
US10379982B2 (en) | 2017-10-31 | 2019-08-13 | Uptake Technologies, Inc. | Computer system and method for performing a virtual load test |
US10635519B1 (en) | 2017-11-30 | 2020-04-28 | Uptake Technologies, Inc. | Systems and methods for detecting and remedying software anomalies |
US10815966B1 (en) | 2018-02-01 | 2020-10-27 | Uptake Technologies, Inc. | Computer system and method for determining an orientation of a wind turbine nacelle |
US10554518B1 (en) | 2018-03-02 | 2020-02-04 | Uptake Technologies, Inc. | Computer system and method for evaluating health of nodes in a manufacturing network |
US10169135B1 (en) | 2018-03-02 | 2019-01-01 | Uptake Technologies, Inc. | Computer system and method of detecting manufacturing network anomalies |
US10635095B2 (en) | 2018-04-24 | 2020-04-28 | Uptake Technologies, Inc. | Computer system and method for creating a supervised failure model |
DE102018110297B4 (en) * | 2018-04-27 | 2023-02-09 | Carl Zeiss Industrielle Messtechnik Gmbh | Method and device for jerk-limited trajectory planning and real-time control of a movement |
US10860599B2 (en) | 2018-06-11 | 2020-12-08 | Uptake Technologies, Inc. | Tool for creating and deploying configurable pipelines |
US10579932B1 (en) | 2018-07-10 | 2020-03-03 | Uptake Technologies, Inc. | Computer system and method for creating and deploying an anomaly detection model based on streaming data |
US11119472B2 (en) | 2018-09-28 | 2021-09-14 | Uptake Technologies, Inc. | Computer system and method for evaluating an event prediction model |
US11181894B2 (en) | 2018-10-15 | 2021-11-23 | Uptake Technologies, Inc. | Computer system and method of defining a set of anomaly thresholds for an anomaly detection model |
US11480934B2 (en) | 2019-01-24 | 2022-10-25 | Uptake Technologies, Inc. | Computer system and method for creating an event prediction model |
US11030067B2 (en) | 2019-01-29 | 2021-06-08 | Uptake Technologies, Inc. | Computer system and method for presenting asset insights at a graphical user interface |
US11797550B2 (en) | 2019-01-30 | 2023-10-24 | Uptake Technologies, Inc. | Data science platform |
US11215004B2 (en) | 2019-03-22 | 2022-01-04 | Ford Global Technologies, Llc | Closed loop door position control |
US11208986B2 (en) | 2019-06-27 | 2021-12-28 | Uptake Technologies, Inc. | Computer system and method for detecting irregular yaw activity at a wind turbine |
US10975841B2 (en) | 2019-08-02 | 2021-04-13 | Uptake Technologies, Inc. | Computer system and method for detecting rotor imbalance at a wind turbine |
CN111158318B (en) * | 2020-01-16 | 2022-10-18 | 江南大学 | Flexible acceleration and deceleration planning method for asymmetric quartic curve |
US11562268B2 (en) | 2020-06-11 | 2023-01-24 | Zebra Technologies Corporation | Estimating physiological load from location data |
US11892830B2 (en) | 2020-12-16 | 2024-02-06 | Uptake Technologies, Inc. | Risk assessment at power substations |
CN113359620B (en) * | 2021-06-15 | 2022-03-15 | 深圳市旗众智能科技有限公司 | Soft limit control method for shaft motion and open type motion controller based on RTX64 |
CN113858213B (en) * | 2021-11-09 | 2023-07-25 | 南京埃斯顿机器人工程有限公司 | Robot dynamic track planning method for target synchronization |
Family Cites Families (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4751984A (en) * | 1985-05-03 | 1988-06-21 | Otis Elevator Company | Dynamically generated adaptive elevator velocity profile |
US4775903A (en) * | 1986-10-14 | 1988-10-04 | Hewlett-Packard Company | Sampled servo seek and track follow system for a magnetic disc drive |
US4723977A (en) | 1986-11-19 | 1988-02-09 | Emhart Industries, Inc. | Electronic servo control of glass gob distribution |
EP0268491A3 (en) | 1986-11-20 | 1988-08-03 | Unimation Inc. | Multiaxis robot having improved motion control |
US4769583A (en) | 1987-05-01 | 1988-09-06 | General Motors Corporation | Motion control system with minimum time path generation |
JPH06274220A (en) * | 1993-03-23 | 1994-09-30 | Mitsubishi Heavy Ind Ltd | Nc device |
JPH086628A (en) * | 1994-06-21 | 1996-01-12 | Fanuc Ltd | Planning and generating method for movement command with limit of increased increased acceleration |
DE59504754D1 (en) | 1994-10-21 | 1999-02-18 | Siemens Ag | Jerk-limited speed control |
JP3599849B2 (en) * | 1995-08-21 | 2004-12-08 | ファナック株式会社 | Distribution method of movement command in servo control |
JPH11514774A (en) * | 1996-09-02 | 1999-12-14 | フィリップス エレクトロニクス ネムローゼ フェンノートシャップ | Control using set value generator |
US5950799A (en) * | 1996-12-24 | 1999-09-14 | Owens-Brockway Glass Container Inc. | Generation of lehr loader motion profile in an individual section glassware forming system |
KR100242447B1 (en) * | 1997-12-31 | 2000-04-01 | 윤종용 | Method and system for path planning in robot control |
US6216058B1 (en) * | 1999-05-28 | 2001-04-10 | Brooks Automation, Inc. | System of trajectory planning for robotic manipulators based on pre-defined time-optimum trajectory shapes |
WO2003007129A2 (en) * | 2001-07-13 | 2003-01-23 | Broks Automation, Inc. | Trajectory planning and motion control strategies for a planar three-degree-of-freedom robotic arm |
US6850386B2 (en) * | 2001-07-18 | 2005-02-01 | Seagate Technology Llc | Control object positioning using an optimum jerk profile to reduce excitation of mechanical resonances |
JP3955217B2 (en) * | 2002-02-15 | 2007-08-08 | 株式会社不二越 | Industrial robot control method and control apparatus |
US6757583B2 (en) | 2002-06-27 | 2004-06-29 | Joe Giamona | Interpolated motion control over a serial network |
US6845287B2 (en) * | 2002-11-20 | 2005-01-18 | Asml Holding N.V. | Method, system, and computer program product for improved trajectory planning and execution |
DE10315525B4 (en) | 2003-04-04 | 2006-04-13 | Siemens Ag | Control method for jerk-limited speed control of a movable machine element of a numerically controlled industrial processing machine |
US20040225382A1 (en) | 2003-05-09 | 2004-11-11 | Phil Brown | Jerk profile, vector motion control and real time position capture in motion control systems |
US7170581B2 (en) * | 2004-10-27 | 2007-01-30 | Asml Netherlands B.V. | Self-adapting feedforward control tuning for motion system, and lithographic apparatus provided with such a motion system |
DE102004059966B3 (en) * | 2004-12-13 | 2006-06-22 | Siemens Ag | Method and device for motion control of a movable machine element of a numerically gesturten machine |
US7208897B2 (en) | 2005-03-04 | 2007-04-24 | Linear Corporation | Motion control system for barrier drive |
JP2010511919A (en) * | 2005-03-23 | 2010-04-15 | ハーコ カンパニーズ,インコーポレイテッド | Tolerance-based path design and control methods |
JP2007086904A (en) * | 2005-09-20 | 2007-04-05 | Brother Ind Ltd | Acceleration trajectory generation device |
CN1971457A (en) * | 2005-11-25 | 2007-05-30 | 中国科学院沈阳计算技术研究所有限公司 | Speed control method used for numerical control machine |
-
2007
- 2007-10-21 US US11/875,913 patent/US7919940B2/en active Active
-
2008
- 2008-08-13 WO PCT/US2008/072966 patent/WO2009055120A2/en active Application Filing
- 2008-08-13 EP EP08797750.0A patent/EP2220544B1/en active Active
- 2008-08-13 JP JP2010530000A patent/JP5343081B2/en active Active
- 2008-08-13 CN CN2008801134171A patent/CN101939711B/en active Active
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104423303A (en) * | 2013-08-28 | 2015-03-18 | 洛克威尔自动控制技术股份有限公司 | Sizing and tuning methodology for optimized motion control components and energy efficiency |
CN104423303B (en) * | 2013-08-28 | 2017-03-15 | 洛克威尔自动控制技术股份有限公司 | The appraisal of optimized control parts of motion and energy efficiency and control method |
CN105388853A (en) * | 2014-08-28 | 2016-03-09 | 发那科株式会社 | numerical control device |
CN105388853B (en) * | 2014-08-28 | 2018-08-24 | 发那科株式会社 | Numerical control device |
CN105539434A (en) * | 2014-08-29 | 2016-05-04 | 通用汽车环球科技运作有限责任公司 | Method of path planning for evasive steering maneuver |
CN105539434B (en) * | 2014-08-29 | 2018-04-13 | 通用汽车环球科技运作有限责任公司 | For hiding the paths planning method of steering operation |
CN108780610A (en) * | 2016-03-24 | 2018-11-09 | 本田技研工业株式会社 | For the system and method for unexpected pedestrian's planned trajectory |
CN109562929A (en) * | 2016-05-24 | 2019-04-02 | Fmc技术公司 | For the motion control apparatus of radial type fluid loading arm, its acquisition and calculation method and equipment and radial type fluid loading arm |
CN110023856A (en) * | 2017-01-10 | 2019-07-16 | 韩华泰科株式会社 | The method and computing device of motion outline are generated by using S type curve |
CN110023856B (en) * | 2017-01-10 | 2022-12-13 | 韩华株式会社 | Method and computing device for generating motion profile by using S-shaped curve |
CN110365280A (en) * | 2018-04-03 | 2019-10-22 | 东元电机股份有限公司 | Motor control system and its method |
US11392107B2 (en) | 2018-09-12 | 2022-07-19 | Siemens Aktiengesellschaft | Time-optimized movement guidance between track sections |
CN112689807A (en) * | 2018-09-12 | 2021-04-20 | 西门子股份公司 | Time-optimized movement guidance between path segments |
CN112689807B (en) * | 2018-09-12 | 2022-04-08 | 西门子股份公司 | Time-optimized movement guidance between path segments |
CN109765851A (en) * | 2019-02-15 | 2019-05-17 | 大族激光科技产业集团股份有限公司 | Speed calculation method, device, storage medium and the computer equipment of track movement |
CN111750162A (en) * | 2019-03-29 | 2020-10-09 | 费斯托股份两合公司 | Trajectory planning unit, valve assembly and method |
CN111750162B (en) * | 2019-03-29 | 2023-12-29 | 费斯托股份两合公司 | Trajectory planning unit, valve assembly and method |
CN110000794A (en) * | 2019-05-06 | 2019-07-12 | 江苏集萃智能制造技术研究所有限公司 | A kind of asymmetric speed planning method of clean cut system based on cooperation robot |
CN111665851A (en) * | 2020-06-30 | 2020-09-15 | 哈工大机器人(合肥)国际创新研究院 | Trajectory planning method and device for dynamically adjusting running speed of robot |
CN111665851B (en) * | 2020-06-30 | 2022-02-11 | 哈工大机器人(合肥)国际创新研究院 | Trajectory planning method and device for dynamically adjusting running speed of robot |
CN113942781B (en) * | 2021-10-15 | 2023-12-01 | 西门子工厂自动化工程有限公司 | Method and apparatus for determining delivery system profile data and computer readable storage medium |
CN113942781A (en) * | 2021-10-15 | 2022-01-18 | 西门子工厂自动化工程有限公司 | Method and apparatus for determining delivery system selection data and computer readable storage medium |
Also Published As
Publication number | Publication date |
---|---|
EP2220544A2 (en) | 2010-08-25 |
US7919940B2 (en) | 2011-04-05 |
US20090102411A1 (en) | 2009-04-23 |
CN101939711B (en) | 2013-11-20 |
WO2009055120A9 (en) | 2011-01-13 |
WO2009055120A2 (en) | 2009-04-30 |
JP2011501292A (en) | 2011-01-06 |
JP5343081B2 (en) | 2013-11-13 |
EP2220544B1 (en) | 2013-10-16 |
WO2009055120A3 (en) | 2010-11-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101939711B (en) | System and method for jerk limited trajectory planning for a path planner | |
US8050800B2 (en) | Method and system for meeting end conditions in a motion control system | |
CN102540978B (en) | High-speed processing-oriented surface quality preferred spline real-time interpolation method | |
CN102419570B (en) | Acceleration and deceleration look-ahead control method for high-speed machining of numerical control machine tool | |
US9678500B2 (en) | Machining program creating device numerical control device, machining system, machining program creating method, numerical control method, and machining program | |
CN101477354B (en) | Position S type instruction generation method | |
US20060241789A1 (en) | Skew compensation | |
CN101004601A (en) | Numerical controller | |
CN105717872B (en) | Method for conditionally stopping at least one manipulator on trajectory and manipulator group | |
CN105955203A (en) | Processing method for speed feedforward and torque feedforward in CANopen servo system | |
CN104204977A (en) | Track control device | |
CN112987568B (en) | Parallel processing robot feeding speed planning method and device | |
WO2013077007A1 (en) | Motor controller | |
CN114077226A (en) | S-shaped curve speed planning method, control terminal and computer readable storage medium | |
CN104023922A (en) | Device and method for controlling weaving motion in real time | |
CN113428218A (en) | Vehicle steering control method, device, equipment and storage medium | |
CN103941646B (en) | servo positioning control system and method | |
CN113858213B (en) | Robot dynamic track planning method for target synchronization | |
CN107645979B (en) | Robot system for synchronizing the movement of a robot arm | |
JP6526370B1 (en) | Numerical control device and control method of additional manufacturing device | |
CN103513656A (en) | Setting of synchronized robot movements | |
CN116300698A (en) | Thread cutting machining method based on dynamic programming | |
CN113031525B (en) | Polynomial acceleration and deceleration motion control method and device applied to numerical control machining | |
CN102279588B (en) | Multi-axis full-closed loop motion control interpolator | |
CN114237152B (en) | Flexible speed planning and displacement compensation method for laser cutting |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CP01 | Change in the name or title of a patent holder |
Address after: Virginia Patentee after: Intelligent platform Co.,Ltd. Address before: Virginia Patentee before: GE INTELLIGENT PLATFORMS, Inc. |
|
CP01 | Change in the name or title of a patent holder |