WO2018195689A1 - S型速度规划方法、装置、系统、机器人以及数控机床 - Google Patents

S型速度规划方法、装置、系统、机器人以及数控机床 Download PDF

Info

Publication number
WO2018195689A1
WO2018195689A1 PCT/CN2017/081605 CN2017081605W WO2018195689A1 WO 2018195689 A1 WO2018195689 A1 WO 2018195689A1 CN 2017081605 W CN2017081605 W CN 2017081605W WO 2018195689 A1 WO2018195689 A1 WO 2018195689A1
Authority
WO
WIPO (PCT)
Prior art keywords
speed
convolution
max
maximum
target route
Prior art date
Application number
PCT/CN2017/081605
Other languages
English (en)
French (fr)
Inventor
张瑞
Original Assignee
深圳配天智能技术研究院有限公司
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 深圳配天智能技术研究院有限公司 filed Critical 深圳配天智能技术研究院有限公司
Priority to CN201780034124.3A priority Critical patent/CN109313429B/zh
Priority to PCT/CN2017/081605 priority patent/WO2018195689A1/zh
Publication of WO2018195689A1 publication Critical patent/WO2018195689A1/zh

Links

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/41—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 interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path
    • G05B19/4103—Digital interpolation

Definitions

  • the invention relates to the technical field of speed planning, in particular to an S-type speed planning method, device, system, robot and numerical control machine tool.
  • curve acceleration/deceleration control In CNC systems and industrial robots, in order to ensure that the machine tool or industrial robot does not produce shock, out-of-step, over-travel or oscillation when starting or stopping or transitioning between two curved segments, curve acceleration/deceleration control is required, that is, special acceleration and deceleration is adopted.
  • the control planning algorithm makes the input of the motor change according to a certain law, and can be quickly and accurately positioned under various processing conditions.
  • the commonly used speed curve planning is S-type speed curve planning.
  • the traditional pure formula derivation method has become quite complicated and computationally intensive.
  • the actual displacement to be taken must be greater than the compensation displacement, otherwise, the maximum feed rate cannot be achieved. At this point, you cannot get the correct speed plan.
  • the technical problem mainly solved by the present invention is to provide an S-type speed planning method, device, system, robot and numerical control machine tool, which can reduce the calculation amount of the S-shaped speed curve planning and can be compatible with different route displacement situations.
  • a technical solution adopted by the present invention is to provide an S-type speed planning method, which includes the following steps: calculating the first time by using the maximum speed V max , the maximum acceleration A and the maximum jerk Jerk of the target route; The convolution window h 1 and the second convolution window h 2 ; the maximum speed V max1 actually reachable at the target route is calculated according to the displacement S of the target route and the time requirement of the convolution to be satisfied; Determining the maximum speed V max1 between the actual speed and the maximum speed V max , and re-adjusting the maximum speed V max of the target route; using the first convolution window h 1 and the second convolution window h 2 The second signal formed by the maximum speed V max of the adjusted target route is subjected to secondary convolution to obtain S-type velocity curve data of the target route.
  • an S-type speed planning device including: a convolution window calculation module, which is configured to utilize the maximum speed V max , the maximum acceleration A, and the maximum acceleration of the target route.
  • the acceleration Jerk calculates the first convolution window h 1 and the second convolution window h 2 ; the speed obtaining module is configured to calculate according to the displacement S of the target route and the time requirement of the convolution to be satisfied.
  • a maximum speed V max1 that is actually reachable by the target route
  • a speed adjustment module for comparing the magnitude between the actually reachable maximum speed V max1 and the maximum speed V max , and re-adjusting the maximum speed of the target route V
  • a max convolution module for performing second convolution on the original signal formed by the maximum velocity V max of the adjusted target route by using the first convolution window h 1 and the second convolution window h 2 S-type velocity curve data of the target route.
  • an S-type speed planning system including an actuator, a driving motor, a processor, and a memory;
  • the memory is configured to store computer instructions and data processed by the processor
  • the processor executes the computer instruction to: calculate a first convolution window h 1 and a second convolution window h 2 by using a maximum speed V max of the target route, a maximum acceleration A, and a maximum jerk Jerk; Calculating the maximum speed V max1 actually reachable at the target route according to the displacement S of the target route and the time requirement of the convolution to be satisfied; comparing the actually reachable maximum speed V max1 with the maximum speed V size between the max, the maximum velocity V max re-tune the entire target route; convolution window using the first and second h 1 h 2 - convolution formed by the maximum speed of the adjusted target route of V max
  • the original signal is subjected to secondary convolution to obtain S-type velocity curve data of the target route; and a control instruction is sent to the driving motor according to the S-type velocity profile data of the target route;
  • the actuator is operative to operate on the target route in accordance with the S-type speed profile driven by the drive motor.
  • yet another technical solution adopted by the present invention is to provide a robot applying an S-type speed planning method, the robot including a control system and a robot arm, and the control system is based on the S-type speed planning described above.
  • the method obtains S-type speed curve data of the target route, and controls the robot arm operation according to the S-type speed curve data.
  • another technical solution adopted by the present invention is to provide a numerical control machine tool using an S-type speed planning method, the numerical control machine tool including a numerical control system and a machine tool, and the numerical control system is based on the S-type speed described above.
  • the planning method obtains S-type speed curve data of the target route, and controls the machine tool to perform machining according to the S-type speed curve data.
  • S-type velocity curve planning is realized by secondary convolution, which reduces the calculation amount compared with the traditional S-type velocity planning, and is re-confirmed according to the uniqueness of the target route and the required convolution time requirement before the secondary convolution. Calculate the maximum speed that can be achieved by the target route, and then adjust the maximum speed of the target route to use the adjusted maximum speed for secondary convolution, avoiding the situation that the target route cannot reach its set maximum speed due to small displacement. Therefore, it is compatible with the displacement of different routes.
  • FIG. 1 is a flow chart of an embodiment of an S-type speed planning method of the present invention
  • FIG. 2 is a schematic diagram of an S-type speed curve obtained in a first application scenario
  • FIG. 3 is a schematic diagram of an S-type speed curve obtained in a second application scenario
  • FIG. 4 is a schematic diagram of an S-type speed curve obtained in a third application scenario
  • FIG. 5 is a schematic diagram of an S-type speed curve obtained in a fourth application scenario
  • Figure 6 is a schematic diagram showing the speed of the secondary convolution process performed in step S14 shown in Figure 1;
  • FIG. 8 is a partial flow chart of still another embodiment of the S-type speed planning method of the present invention.
  • Figure 9 is a schematic diagram of compensation of the original signal of the target route obtained by the step shown in Figure 8;
  • FIG. 10 is a partial flow chart of still another embodiment of the S-type speed planning method of the present invention.
  • FIG. 11 is a schematic diagram showing the principle of calculating the maximum speed of the segment point in step S103 shown in FIG. 10;
  • FIG. 12 is a schematic diagram of speed adjustment when performing verification in step S104 shown in FIG. 10; FIG.
  • FIG. 13 is a schematic structural view of an embodiment of an S-type speed planning device according to the present invention.
  • Figure 14 is a schematic structural view of another embodiment of the S-type speed planning device of the present invention.
  • FIG. 15 is a schematic structural view of an embodiment of an S-type speed planning system according to the present invention.
  • FIG. 16 is a schematic structural view of an embodiment of a robot according to the present invention.
  • Figure 17 is a block diagram showing an embodiment of a numerically controlled machine tool of the present invention.
  • the following S-type speed planning method and related device can be applied to a system such as a numerical control system and an industrial robot that requires speed planning for its components, for example, one or more routes executed by the arm of a numerical control system machine or an industrial robot.
  • Speed planning to enable the machine or industrial robot to accelerate from the initial speed to the maximum speed from the beginning of the route and from the maximum speed to the end speed to the end of the route.
  • the route can be a straight line or a curve.
  • FIG. 1 is a flow chart of an embodiment of an S-type speed planning method according to the present invention.
  • the method is performed by an S-type speed planning device for performing the S-type speed planning on an operating speed of an object, such as the planning device being a numerical control system or a processor of an industrial robot, etc., the object is a numerical control System of machine tools or arms of industrial robots, etc.
  • the method takes an example of a machine tool whose numerical control system is used, and the method includes the following steps:
  • the above target route is a route that the speed planning object is about to need to run, and the maximum speed V max , the maximum acceleration A and the maximum jerk Jerk, the starting speed V i and the ending speed V f of the route are already when the method is executed.
  • the setting is specifically as set according to the driving ability of driving the object or the specific task performed by the object on the route; or input for the user.
  • the S-type velocity planning is implemented by using secondary convolution, and by controlling the size of the convolution window, the convolution rise time and the fall time can be controlled, that is, the magnitude of the acceleration and the jerk can be controlled, so the target route can be adopted.
  • the set maximum acceleration and maximum jerk can be calculated to the size of the corresponding convolution window.
  • the time of the first convolution window considers the starting and ending speed, that is, the maximum speed V max , the starting speed V i and the ending speed V f of the target route are utilized.
  • the minimum value, the maximum acceleration A, and the maximum jerk Jerk calculate the first convolution window h 1 and the second convolution window h 2 .
  • 1 is calculated using the following formula convolution first time t 1 and second time t 2 convolution, and using the following formula 2 to obtain first and second convolution windows h 1 Secondary convolution window h 2 .
  • ⁇ V is the difference between the maximum speeds V max and V min of the target route
  • V min min(V i , V f )
  • V i is the starting speed of the target route
  • V f is the target end of line speed, i.e., t 1 of the convolution before rising from an initial velocity to a maximum velocity V i
  • V max is the maximum time and the fall from the maximum velocity V max to the speed V f between the end time; T s For the interpolation cycle.
  • the first convolution window h 1 and the second convolution window h 2 are discrete functions, so
  • the size (that is, its length) is the ratio of its corresponding time to the interpolation period and is rounded, and the heights of the first convolution window h 1 and the second convolution window h 2 can be fixed to 1.
  • the size of the first convolution window obtained in the above manner can ensure that the acceleration does not exceed the limit, and the size of the second convolution window obtained by the above manner can ensure that the acceleration is not exceeded.
  • V min min(V i , V f )
  • t 2 is the time of the second convolution window
  • S c is the compensation displacement.
  • the compensation displacement S c is the difference between the signal area after the secondary convolution (representing the displacement of the target route) and the original signal area, and the compensation displacement S c can be obtained by the following formula 4.
  • the above formula 3 represents the time requirement of the convolution to be satisfied by the target route, and the left side of the equal sign indicates the time length t 0 of the original signal of the target route, and the right side of the equal sign indicates the length of one convolution and the second convolution time. And t 1 + t 2 , so after a secondary convolution, just to reach a speed value, there is no uniform velocity section in the entire S-type speed plan.
  • V max1 calculated by the above formula 5 is the maximum speed V max1 actually reachable in the target route, and then the subsequent S-type convolution plan is performed according to the maximum value V max1 .
  • the magnitude between the actually reachable maximum speed V max1 and the maximum speed V max is compared, and the maximum speed V max of the target route is adjusted according to the following two comparison results.
  • V max1 ⁇ V max the maximum speed V max of the target route is maintained.
  • V max1 is greater than or equal to V max
  • the speed at which the S-type convolution plan arrives can be calculated as V max , so the maximum speed V max of the target route does not need to be adjusted and remains unchanged.
  • the S-shaped velocity curve obtained after the second convolution through the following step S14 is as shown in FIG.
  • V max1 ⁇ V max the maximum speed V max of the target route is adjusted to V max1 .
  • V max1 When V max1 is less than V max , the speed at which the S-type convolution plan arrives cannot be calculated as V max , so the maximum speed V max of the target route needs to be adjusted to V max1 ⁇ V max .
  • the specific comparison result can be further subdivided into the following:
  • the above max(V i , V f ) represents the maximum value of the initial velocity V i and the ending velocity V f of the target route.
  • the original signal y 0 (k) of the target route indicates that the time is the independent variable and the maximum speed V max of the target route is a function value.
  • the original signal y 0 (k) is convolved with the first convolution window h 1 (k) for the first time, and the first convolution result y 1 (k) is compared with the second convolution window.
  • h 2 (k) performs a second convolution, and the output obtains the S-shaped velocity profile data y 2 (k) of the target route, as shown in FIG. 6.
  • the size of the original signal y 0 (k) is t 0 is its length of time
  • the height of the original signal y 0 (k) is V max
  • the size of the first convolution window h 1 (k) is That is, t 1 is the first convolution window time
  • the size of the second convolution window h 2 (k) is That is, t 2 is the second convolution window time.
  • the S-type velocity output curve can be obtained in an iterative recursive manner to further reduce the amount of computation. Specifically, the original signal y 0 (k) of the target route is subjected to secondary convolution using Equations 6 and 7 below to obtain an S-type velocity profile signal y 2 (k).
  • k is an integer of maxh+1 to maxh+L
  • the maxh is the number of zeros of the original signal compensation at the time of convolution
  • L is the total time length t 0 +t 1 after the secondary convolution
  • h 1 is the first convolution window
  • h 2 is the second convolution window
  • y 1 (k) is the signal of the first convolution output
  • y 2 ( k) A signal representing the S-type velocity curve output for the second convolution.
  • This iterative recursive method further reduces the amount of computation relative to the direct quadratic convolution operation, and directly calculates the second convolution value by using the result of the first convolution.
  • This strategy implements the secondary volume in one cycle. For the product, the signal y 2 (k) of the output S-type velocity curve can be obtained.
  • step S11 step a
  • steps S11 step a
  • steps S11 step a
  • steps S11 may be performed before, during or after step S12 (step b) and step S13 (step c)
  • the order of execution of the step is not limited by the present invention.
  • the S-type velocity curve planning is implemented by using the secondary convolution, which reduces the calculation amount compared with the conventional S-type velocity planning, and the unique and required convolution time according to the target route before the secondary convolution. It is required to recalculate the maximum speed that can be achieved by the target route, and then adjust the maximum speed of the target route to perform secondary convolution with the adjusted maximum speed, thereby avoiding that the target route cannot reach its set maximum speed due to small displacement. The situation is so compatible with the displacement of different routes.
  • FIG. 7 is a flow chart of another embodiment of the S-type speed planning method of the present invention. Compared with the previous embodiment, the method of this embodiment further includes the following steps:
  • S71 Determine whether the target route can perform S-type speed planning. If yes, execute S11 above, otherwise the process ends.
  • Equation 8 The meaning of the symbolic representation in Equation 8 is as described in the above embodiment.
  • the times t 1 and t 2 of the first convolution window and the second convolution window may not be integer multiples of the interpolation period Ts, and there is a rounding error at this time.
  • This embodiment performs the following S72-S74 to achieve elimination of the rounding error.
  • the rounding strategy is to round up the first convolution window and the second convolution window according to the interpolation period. That is, the first convolution window h 1 and the second convolution window h 2 are rounded by the following formula 9.
  • the rounded compensation displacement S c is recalculated using the following equations 10 and 11.
  • T 1 h 1 *Ts
  • T 2 h 2 *Ts (10);
  • T 1 +T 2 is a time from the initial velocity V i to the maximum velocity V max or from the maximum velocity V max to the ending velocity V f after the secondary convolution.
  • T 1 +T 2 is the secondary convolution
  • the T 1 + T 2 is the time from the maximum speed V max to the end speed V f after the secondary convolution.
  • the maximum speed of the uniform motion section is V′ max , so the displacement of the uniform velocity section is determined, and the corresponding total interpolation time is also determined. After the integer multiple of the interpolation period is rounded up, there will be a corresponding displacement error ⁇ S.
  • the relationship between the compensation displacement S c , the displacement error ⁇ S and the maximum speed V′ max is as follows:
  • the maximum speed V max as the target maximum velocity V max route That is, the maximum speed reached is appropriately lowered to V'max so that the displacement is not deviated.
  • S14 is executed using the maximum speed V max of the adjusted target route to achieve rounding of the S-type speed plan, and after executing S14, S75 is executed.
  • S75 Calculate a corresponding number of interpolation positions according to the discrete speed sequence, and control the object to operate on the target route according to the interpolation position.
  • a discrete velocity sequence on the S-type velocity curve is obtained, and an interpolation position corresponding to each discrete velocity value in the sequence is calculated, and specific interpolation can be calculated by using each velocity value.
  • the interpolation distance between the positions, and the interpolation distance is accumulated to obtain the interpolation position. Control the machine or robot after getting the interpolation position The arm runs at the interpolation position in the target route with an interpolation cycle.
  • step S71 and step S75 may be omitted, that is, not performed.
  • FIG. 8 is a partial flow chart of still another embodiment of the S-type speed planning method of the present invention. Since the rounding mode shown in Fig. 7 achieves the elimination error by adjusting the speed increase or fall time T 1 + T 2 and the maximum speed V max , the maximum speed reduction affects the machining efficiency. Therefore, different from the embodiment shown in FIG. 7, the method of the embodiment does not perform the rounding manner described in the above S72-S74, but performs the displacement compensation method described in the following steps S81-S84 to eliminate the rounding error.
  • the S81-82 is specifically described in the above S72-S73, and the S83 can specifically calculate the displacement error ⁇ S by using the above formula 12.
  • the maximum speed of the target route is the adjusted maximum speed V max obtained in the above S13, and the maximum speed in the formula 12 is also the adjusted maximum speed V max obtained in S13.
  • the discrete velocity value is such that the total displacement after convolution is a nominal value.
  • the discrete convolution operation cannot be performed.
  • the value of less than one compensation period is added to the value of the area equal to the compensation period according to the equivalent area (the shaded area in the figure), and then compensated to the position where the original signal y 0 (k) starts to obtain a new value.
  • the compensated area can be smoothed. This method is equivalent to using the convolution window to average the remaining area, and then placing the average velocity value in the interval at which the velocity rise starts. After the smoothing of the secondary convolution, the velocity fluctuation can be effectively reduced.
  • the fluctuation control is within the effective range, so that the S-shaped speed curve can be obtained relatively smoothly, and the acceleration fluctuation after the secondary convolution can be significantly reduced. Among them, the larger the relative convolution window, the better the average effect and the smaller the fluctuation.
  • FIG. 10 is a partial flow chart of still another embodiment of the S-type speed planning method of the present invention. In this embodiment, the following steps are further included:
  • each adjacent two segment points form a route.
  • S102 Calculate a velocity V(n) of each segment point according to a displacement between each adjacent segment point of the N segment points, an initial velocity and an ending velocity of a total route of the N segment points.
  • the route composed of each adjacent segment point Q(n), Q(n+1) of the N segment coordinates is L(n), where n is 1 to N-1.
  • the L(1), L(2), ..., L(N-1) constitute a general route L composed of the N segment points.
  • the total route L is a route that accelerates to the maximum speed at the initial speed V(1) of 0, and the speed from the maximum speed to the end speed V(N) is zero.
  • the displacement of each segment L(n) is calculated by using N segment coordinates. Starting from the initial velocity of 0, the velocity corresponding to each segment Q(n) can be calculated by using the displacement of each segment L(n). V(n), so that it accelerates to the maximum speed and then decelerates to the end point of the last point.
  • each segment L(n) is V i and the endpoint velocity is V f .
  • S-type acceleration/deceleration is delayed compared to trapezoidal acceleration/deceleration, and the delay time is A/Jerk.
  • the triangular area Sn enclosed by the dotted line and the coordinate axis as shown in FIG. 11 is the distance of the route L(n) taken by the S-type velocity plan.
  • V i the displacement of the route L(n)
  • A the displacement of the route L(n)
  • Jerk the displacement of the route L(n)
  • Equation 14 (a) For the case of V f >V i , the equation for V f is solved by Equation 14:
  • V f must have a real solution.
  • V f the maximum value of V f cannot exceed this value to make S-type speed planning.
  • Equation 15 For the case of V f ⁇ V i , the equation for V f is obtained from Equation 15:
  • the Vf_down is the minimum end speed value that can be reduced, enabling it to complete an S-type speed plan.
  • S104 The following forward test is performed by sequentially n from 1 to N-1, and n is sequentially subjected to the following backward test from N-1 to 2.
  • the forward test is as follows:
  • V(n+1) is greater than V(n).
  • n is incremented by 1 and the above test V(n+1) is continued to be greater than V(n) until the n is N-1, and the forward check is ended.
  • the current route can be S-type speed planning, and the determination can be made as described in S71 above. If the S-type speed planning is not possible, the speed Vf_up that can be reached by the n+1th segment obtained by V(n+1) to the above S103 is lowered, as shown in FIG. 12, and n is incremented by 1 and the above test is continued. Whether V(n+1) is greater than V(n) until the n is N-1, the forward test is ended; if S-type velocity planning is possible, n is directly incremented by 1 and the above test is continued V(n+ 1) Whether it is greater than V(n) until the n is N-1, the forward test is ended.
  • the current route is a route composed of an nth segment and a n+1 segment.
  • the backward test is as follows:
  • V(n-1) is greater than V(n).
  • n is directly decremented by one and continues whether the above test V(n-1) is greater than V(n) until the n is 2, and the backward test is ended.
  • the current route can be S-type speed planning, and the determination can be made as described in S71 above. If the S-type speed planning is not possible, the speed Vf_up that can be reached by the n-1th segment obtained by V(n-1) to the above S103 is lowered, as shown in FIG. 12, and n is decremented by 1 and the above test is continued. Whether V(n-1) is greater than V(n) until the n is 2, the backward test is ended; if the S-type velocity plan can be performed, n is directly decremented by 1 and the above test V(n-1) is continued. Whether it is greater than V(n) until the n is 2, the backward test is ended.
  • the current route is a route composed of an nth point and an n-1th point.
  • Each adjacent two of the segment points respectively constitute a route as a target route.
  • the above-mentioned routes L(1), L(2), ..., L(N-1) are respectively taken as the target routes in the above embodiment, and the above-described embodiment steps are executed to perform the S-type speed on the target route. planning.
  • the above S71 can be repeatedly executed to determine whether the S-type speed planning can be performed.
  • FIG. 13 is a schematic structural diagram of an embodiment of an S-type speed planning device according to the present invention.
  • the device 130 includes a convolution window calculation module 131, a speed obtaining module 132, a speed adjustment module 133, and a convolution module 134.
  • the convolution window calculation module 131 is configured to calculate the first convolution window h 1 and the second convolution window h 2 by using the maximum speed V max , the maximum acceleration A and the maximum jerk Jerk of the target route;
  • the speed obtaining module 132 is configured to calculate a maximum speed V max1 that is actually reachable in the target route according to the displacement S of the target route and the time requirement of the convolution to be satisfied;
  • the speed adjustment module 133 is configured to compare the size between the actually reachable maximum speed Vmax1 and the maximum speed Vmax , and re-adjust the maximum speed Vmax of the target route;
  • the convolution module 134 is configured to perform second convolution on the original signal formed by the maximum speed V max of the adjusted target route by using the first convolution window h 1 and the second convolution window h 2 to obtain the target. S-type speed curve data for the route.
  • the speed adjustment module 133 is specifically configured to compare a size between the actually reachable maximum speed V max1 and the maximum speed V max ; when V max1 ⁇ V max , maintain a maximum speed of the target route V max is unchanged; when V max1 ⁇ V max , the maximum speed V max of the target route is adjusted to V max1 .
  • the convolution module 134 is specifically configured to perform secondary convolution of the original signal y 0 (k) of the target route by using Equations 6 and 7 above to obtain an S-type velocity curve signal y 2 (k).
  • the speed obtaining module 132 is specifically configured to calculate, by using Equation 3 above, a maximum speed V max1 that is actually reachable on the target route.
  • the convolution window calculation module 131 is specifically configured to calculate the first convolution window h 1 and the second convolution window h 2 by using the above formulas 1 and 2 .
  • FIG. 14 is a schematic structural view of another embodiment of the S-type speed planning device of the present invention.
  • the device 140 includes a determination module 141, a rounding module 142, an interpolation position module 143, and a look-ahead module 144 in addition to the module shown in FIG.
  • the determining module 141 is configured to determine whether the target route can be S-type speed planning, and can be determined by using Equation 8 above.
  • the convolution window calculation module 131 is specifically configured to perform S-type speed planning on the target route, and performs the functions described in the previous embodiment.
  • the rounding module 142 is configured to round the first convolution window h 1 and the second convolution window h 2 according to the interpolation period Ts; using the rounded first convolution window h 1 And recalculating the compensation displacement S c with the second convolution window h 2 ; using the relationship between the compensation displacement S c , the displacement error ⁇ S and the maximum velocity V′ max , calculating the maximum velocity V′ when the displacement error is zero Max is taken as the maximum speed V max of the target route.
  • the rounding module 142 may not perform the above functions, but is used to: round the first convolution window h 1 and the second convolution window h 2 according to the interpolation period Ts; Compensating the displacement S c by using the rounded first convolution window h 1 and the second convolution window h 2 ; calculating the displacement error by using the relationship between the compensation displacement S c and the displacement error ⁇ S ⁇ S; add one before the original signal of the target route The discrete velocity value is taken as the new original signal to get the target route.
  • the interpolation position module 143 is configured to calculate a corresponding number of interpolation positions according to the discrete speed sequence, and control the object to operate on the target route according to the interpolation position.
  • the look-ahead module 144 is configured to acquire the input N segment coordinates; calculate each segment according to the displacement between each adjacent segment of the N segment points, the initial velocity and the ending velocity of the N segment coordinates The velocity of the point V(n); n is sequentially performed from 1 to N-1 for the above-described forward inspection; n is sequentially performed from N to 2 for the above backward verification.
  • the modules in the foregoing apparatus may respectively perform the corresponding steps in the foregoing method embodiments, and therefore, the modules are not described herein. For details, refer to the description of the corresponding steps.
  • FIG. 15 is a schematic structural diagram of an embodiment of an S-type speed planning system according to the present invention.
  • the S-type speed planning system can perform the steps of the above method.
  • the S-type speed planning system can be specifically a numerical control system, an industrial robot, or the like.
  • the S-type speed planning system 150 includes a processor 151, a memory 152 connected to the processor 151, a driving motor 153, and an actuator 154 connected to the driving motor 153.
  • the actuator 154 is also the planning object in the above embodiment.
  • it is a machine tool of a numerical control system, an arm of an industrial robot, or the like
  • the drive motor 153 is a servo motor or the like that drives the machine tool or the robot.
  • the memory 152 is used to store computer instructions executed by the processor 151 and data of the processor 151 during processing such as setting the maximum speed, maximum acceleration, maximum jerk, etc. of the target route.
  • the processor 151 executes the computer instructions and can be used to:
  • the first convolution window h 1 and the second convolution window h 2 are used to perform secondary convolution on the original signal formed by the adjusted maximum speed V max of the target route to obtain an S-shaped velocity curve of the target route. data;
  • the actuator 154 is operable to operate in accordance with the S-shaped speed profile on the target route under the drive of the drive motor 153.
  • the processor 151 is specifically configured to: compare a size between the actually reachable maximum speed V max1 and the maximum speed V max ; when V max1 ⁇ V max , maintain a maximum speed of the target route V max is unchanged; when V max1 ⁇ V max , the maximum speed V max of the target route is adjusted to V max1 .
  • the processor 151 is specifically configured to: perform secondary convolution on the original signal y 0 (k) of the target route by using Equations 6 and 7 to obtain an S-type velocity curve signal y 2 (k).
  • the processor 151 is specifically configured to calculate, by using the above formulas 1, 3 and 4, the maximum speed V max1 that is actually reachable on the target route.
  • the processor 151 calculates the first convolution window h 1 and the second convolution window h 2 by using the above formulas 1 and 2 .
  • the processor 151 is further configured to round the first convolution window h 1 and the second convolution window h 2 according to the interpolation period Ts; using the rounded first volume
  • the accumulation window h 1 and the second convolution window h 2 recalculate the compensation displacement S c ; using the relationship between the compensation displacement S c , the displacement error ⁇ S and the maximum velocity V′ max , when the displacement error is zero
  • the maximum speed V'max is taken as the maximum speed Vmax of the target route.
  • the processor 151 is further configured to: round the first convolution window h 1 and the second convolution window h 2 according to the interpolation period Ts; use the rounded first time
  • the convolution window h 1 and the second convolution window h 2 recalculate the compensation displacement S c ; using the relationship between the compensation displacement S c and the displacement error ⁇ S, the displacement error ⁇ S is calculated; the original signal at the target route Add one before The discrete velocity value is taken as the new original signal to get the target route.
  • the processor 151 is further configured to: obtain the input N segment point coordinates, where each adjacent two segment points constitute a segment; according to the displacement between each adjacent segment point of the N segment points The initial velocity and the ending velocity of the N segment coordinates are calculated to obtain the velocity V(n) of each segment point; n is sequentially performed from 1 to N-1 to perform the foregoing forward inspection; n is sequentially performed from N to 2 The above-mentioned backward test; each adjacent two of the segment points respectively constitute a route as a target route.
  • the processor 151 is further configured to calculate the speed Vf_up reachable by each segment point according to the above formula 17.
  • the present invention also provides a robot.
  • the robot 160 includes a control system 161 and a robot arm 162.
  • the control system 161 obtains S-type speed curve data of the target route according to the S-type speed planning method described above. And controlling the operation of the robot arm 162 according to the S-type speed curve data.
  • the present invention also provides a numerical control machine tool, which includes a numerical control system 171 and a machine tool 172, and the numerical control system 171 obtains S-type speed curve data of the target route according to the S-type speed planning method described above, and according to the The S-type speed profile data controls the machine tool 172 for machining.
  • S-type velocity curve planning is realized by secondary convolution, which reduces the calculation amount compared with the traditional S-type velocity planning, and is re-confirmed according to the uniqueness of the target route and the required convolution time requirement before the secondary convolution.
  • the maximum speed that can be reached by the target route, and then the maximum speed of the target route is adjusted to perform secondary convolution with the adjusted maximum speed, thereby avoiding the situation that the target route cannot reach the set maximum speed due to the small displacement. Therefore, it is compatible with the displacement of different routes.

Landscapes

  • Engineering & Computer Science (AREA)
  • Computing Systems (AREA)
  • Theoretical Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)

Abstract

一种S型速度规划方法、装置、系统、机器人以及数控机床。其中，所述方法包括：利用目标路线的最大速度、最大加速度以及最大加加速度计算得到第一次卷积窗和第二次卷积窗（S11）；根据目标路线的位移以及所需满足的卷积的时间要求，计算得到在所述目标路线实际可达的最大速度（S12）；比较所述实际可达的最大速度与所述最大速度之间的大小，重新调整所述目标路线的最大速度（S13）；利用第一次卷积窗和第二次卷积窗对由调整后的目标路线的最大速度形成的原始信号进行二次卷积，得到所述目标路线的S型速度曲线数据（S14）。通过上述方式，能够减少S型速度曲线规划的运算量，并且能够兼容不同路线位移的情况。

Description

S型速度规划方法、装置、系统、机器人以及数控机床 【技术领域】
本发明涉及速度规划技术领域，特别是涉及S型速度规划方法、装置、系统、机器人以及数控机床。
【背景技术】
数控系统和工业机器人中，为了保证机床或工业机器人在启动停止或者两条曲线段之间过渡时不产生冲击、失步、超程或者震荡，需要进行曲线加减速控制，即采用专门的加减速控制规划算法，使得电机的输入按照一定的规律进行变化，在各种加工情况下都能快速、准确的定位。
目前，常用的速度曲线规划为S型速度曲线规划。鉴于S型速度曲线规划复杂情况，采用传统的纯公式推导的方式，规划流程变得相当复杂，计算量大。而且，现有的S型速度曲线规划方案中，实际要走的位移必须大于补偿位移，否则，无法达到最大进给速度。此时，则无法得到正确的速度规划。
【发明内容】
本发明主要解决的技术问题是提供S型速度规划方法、装置、系统、机器人以及数控机床，能够减少S型速度曲线规划的运算量，并且能够兼容不同路线位移的情况。
为解决上述技术问题，本发明采用的一个技术方案是：提供一种S型速度规划方法，包括以下步骤：利用目标路线的最大速度Vmax、最大加速度A以及最大加加速度Jerk计算得到第一次卷积窗h1和第二次卷积窗h2；根据目标路线的位移S以及所需满足的卷积的时间要求，计算得到在所述目标路线实际可达的最大速度Vmax1；比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小，重新调整所述目标路线的最大速度Vmax；利用第一次卷积窗h1和第二次卷积窗h2对由调整后的目标路线的最大速度Vmax形成的原始信号进行二次卷积，得到所述目标路线的S型速度曲线数据。
为解决上述技术问题，本发明采用的另一技术方案是，提供一种S型速度规划装置，包括：卷积窗计算模块，用于利用目标路线的最大速度Vmax、最大加速度A以及最大加加速度Jerk计算得到第一次卷积窗h1和第二次卷积窗h2；速度获得模块，用于根据目标路线的位移S以及所需满足的卷积的时间要求，计算得到在所述目标路线实际可达的最大速度Vmax1；速度调整模块，用于比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小，重新调整所述目标路线的最大速度Vmax；卷积模块，用于利用第一次卷积窗h1和第二次卷积窗h2对由调整后的目标路线的最大速度Vmax形成的原始信号进行二次卷积，得到所述目标路线的S型速度曲线数据。
为解决上述技术问题，本发明采用的再一技术方案是，提供一种S型速度规划系统，包括执行元件、驱动电机、处理器和存储器；
所述存储器用于存储计算机指令以及所述处理器处理的数据；
所述处理器执行所述计算机指令，用于：利用目标路线的最大速度Vmax、最大加速度A以及最大加加速度Jerk计算得到第一次卷积窗h1和第二次卷积窗h2；根据目标路线的位移S以及所需满足的卷积的时间要求，计算得到在所述目标路线实际可达的最大速度Vmax1；比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小，重新调 整所述目标路线的最大速度Vmax；利用第一次卷积窗h1和第二次卷积窗h2对由调整后的目标路线的最大速度Vmax形成的原始信号进行二次卷积，得到所述目标路线的S型速度曲线数据；根据所述目标路线的S型速度曲线数据向所述驱动电机发送控制指令；
所述执行元件用于在所述驱动电机的驱动下在目标路线上按照所述S型速度曲线进行运作。
为解决上述技术问题，本发明采用的又再一技术方案是，提供一种应用S型速度规划方法的机器人，所述机器人包括控制系统和机器臂，所述控制系统根据上述的S型速度规划方法得到目标路线的S型速度曲线数据，并根据所述S型速度曲线数据控制所述机器臂运行。
为解决上述技术问题，本发明采用的另再一技术方案是，提供一种应用S型速度规划方法的数控机床，所述数控机床包括数控系统和机床，所述数控系统根据上述的S型速度规划方法得到目标路线的S型速度曲线数据，并根据所述S型速度曲线数据控制所述机床进行加工。
以上方案，采用二次卷积实现S型速度曲线规划，相对于传统的S型速度规划减少了计算量，而且在二次卷积前根据目标路线的唯一和所需满足的卷积时间要求重新计算目标路线可达到的最大速度，进而对目标路线的最大速度进行调整，以利用调整后的最大速度进行二次卷积，避免了由于目标路线由于位移小无法达到其设定的最大速度的情况，故能够兼容不同路线位移的情况。
【附图说明】
图1是本发明S型速度规划方法一实施例的流程图；
图2是在第一应用场景得到的S型速度曲线示意图；
图3是在第二应用场景得到的S型速度曲线示意图；
图4是在第三应用场景得到的S型速度曲线示意图；
图5是在第四应用场景得到的S型速度曲线示意图；
图6是经图1所示的步骤S14进行二次卷积过程的速度示意图；
图7是本发明S型速度规划方法另一实施例的流程图；
图8是本发明S型速度规划方法再一实施例的部分流程图；
图9是经图8所示步骤得到的目标路线的原始信号的补偿示意图；
图10是本发明S型速度规划方法又再一实施例的部分流程图；
图11是图10所示的步骤S103中计算段点可达最大速度的原理示意图；
图12是图10所示的步骤S104进行校验时的速度调整示意图；
图13是本发明S型速度规划装置一实施例的结构示意图；
图14是本发明S型速度规划装置另一实施例的结构示意图；
图15是本发明S型速度规划系统一实施例的结构示意图；
图16是本发明机器人一实施例的结构示意图；
图17是本发明数控机床一实施例的结构示意图。
【具体实施方式】
以下描述中，为了说明而不是为了限定，提出了诸如特定系统结构、接口、技术之类的具体细节，以便透彻理解本申请。然而，本领域的技术人员应当清楚，在没有这些具体细节的其它实施方式中也可以实现本申请。在其它情况中，省略对众所周知的装置、电路以及方法的详细说明，以免不必要的细节妨碍本申请的描述。
下述S型速度规划方法及其相关装置可应用于数控系统和工业机器人等需要对其部件进行速度规划的系统，例如，对数控系统的机床或工业机器人的手臂执行的一段或多段路线进行该速度规划，以使机床或工业机器人能够从该路线的起点开始从初始速度加速到最大速度，并运行到该路线的终点时从最大速度降速至结束速度。该路线可以为直线或曲线。
请参阅图1，图1是本发明S型速度规划方法一实施例的流程图。本实施例中，该方法由S型速度规划装置执行，用于对一对象的运行速度进行该S型速度规划，具体如该规划装置为数控系统或工业机器人的处理器等，该对象为数控系统的机床或工业机器人的手臂等。本实施例以对象为数控系统的机床为例，该方法包括以下步骤：
S11：利用目标路线的最大速度Vmax、最大加速度A以及最大加加速度Jerk计算得到第一次卷积窗h1和第二次卷积窗h2。
其中，上述目标路线为速度规划对象即将需要运行的路线，该路线的该最大速度Vmax、最大加速度A以及最大加加速度Jerk、起始速度Vi和结束速度Vf为在执行该方法时已设定的，具体如根据驱动该对象的驱动能力或该对象在该路线上所执行的具体任务而设定的；或者为用户输入的。
本实施例采用二次卷积来实现S型速度规划，且通过控制卷积窗的大小，可控制卷积上升时间和下降时间，也就是控制加速度和加加速度的大小，故可通过该目标路线的设定的最大加速度和最大加加速度可计算得到对应的卷积窗的大小。
为了保证能够得到起止速度不为0的S型速度规划曲线，该第一次卷积窗的时间考虑起止速度，即利用目标路线的最大速度Vmax、起始速度Vi和结束速度Vf的最小值、最大加速度A以及最大加加速度Jerk计算得到第一次卷积窗h1和第二次卷积窗h2。具体地，利用下述公式1计算得到第一次卷积窗的时间t1和第二次卷积窗的时间t2，并利用下述公式2得到第一次卷积窗h1和第二次卷积窗h2。
Figure PCTCN2017081605-appb-000001
Figure PCTCN2017081605-appb-000002
其中，所述ΔV为目标路线的最大速度Vmax与Vmin间的差，所述Vmin＝min(Vi，Vf)，Vi为该目标路线的起始速度，Vf为该目标路线的结束速度，即，该t1为在卷积前从初始速度Vi上升到最大速度Vmax的时间与从最大速度Vmax下降到结束速度Vf的时间之间的最大值；Ts为插补周期。本实施例中，由于机床是根据插补周期运行的，即每隔插补周期走一步，故该第一次卷积窗h1和第二次卷积窗h2为离散型函数，故其大小(也即其长度)分别为其对应时间与插补周期间的比值并取整，该第一次卷积窗h1和第二次卷积窗h2的高度则可固定取1。经上述方式得到的第一次卷积窗的大小可保证加速度不超限，经上述方式得到的第二次卷积窗的大小可保证加加速度不超限。
上述公式1中由于第一次卷积窗的时间t1利用上述速度差ΔV求得，故可得到起止速度不为0的速度规划曲线。
S12：根据目标路线的位移S以及所需满足的卷积的时间要求，计算得到在所述目标路线实际可达的最大速度Vmax1。
由于当目标路线的位移太小时存在达不到最大速度Vmax的情况，在此情况下，S型速度曲线中没有匀速段，只有速度上升和速度下降段，故基于此条件，根据目标路线实际的位移S以及所需满足的卷积的时间要求，利用下述公式3重新计算出能够达到一次 卷积的最大速度Vmax1；
Figure PCTCN2017081605-appb-000003
其中，Vmin＝min(Vi，Vf)，所述t2为所述第二次卷积窗的时间，所述Sc是补偿位移。该补偿位移Sc即为二次卷积后的信号面积(表示目标路线的位移)与原始信号面积之间的差，该补偿位移Sc可以由下述公式4得到。
Sc＝0.5*(Vi+Vf)*(t1+t2)     (4)；
上述公式3表示所述目标路线所需满足的卷积的时间要求，其等号左边表示目标路线的原始信号的时间长度t0，其等号右边表示一次卷积和二次卷积时间长度之和t1+t2，这样经过二次卷积后，刚好达到一个速度值，整个S型速度规划中没有匀速段。
结合上述公式1、4对上述公式3解二次方程得到下述公式5：
Figure PCTCN2017081605-appb-000004
由上述公式5计算得到重解后的Vmax1为在所述目标路线实际可达的最大速度Vmax1，则在后续S型卷积规划按该最大值Vmax1进行。
S13：比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小，重新调整所述目标路线的最大速度Vmax。
具体地，比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小，并根据以下两种比较结果调整该目标路线的最大速度Vmax。
A、当Vmax1≥Vmax，则维持所述目标路线的最大速度Vmax不变。
当Vmax1大于等于Vmax时，S型卷积规划到达的速度则可按Vmax来计算，故目标路线的最大速度Vmax不需调整，维持不变。经下述步骤S14进行二次卷积后得到的S型速度曲线如图2。
B、当Vmax1＜Vmax，则将所述目标路线的最大速度Vmax调整为Vmax1。
当Vmax1小于Vmax时，S型卷积规划到达的速度则不可按Vmax来计算，故目标路线的最大速度Vmax需调整为Vmax1＜Vmax。具体该比较结果可进一步细分为以下：
B1、当max(Vi，Vf)＜Vmax1＜Vmax时，经下述步骤S14进行二次卷积后得到的S型速度曲线如图3；
B2、当max(Vi，Vf)＝Vmax1时，经下述步骤S14进行二次卷积后得到的S型速度曲线如图4；
B3、当max(Vi，Vf)＞Vmax1时，经下述步骤S14进行二次卷积后得到的S型速度曲线如图5。此时，单段S型速度曲线难以满足要求，故通过2段S型速度曲线平滑的过渡，完成该S型速度规划。
其中，上述max(Vi，Vf)表示目标路线的初始速度Vi和结束速度Vf中的最大值。
S14：利用第一次卷积窗h1和第二次卷积窗h2对由调整后的目标路线的最大速度Vmax形成的原始信号进行二次卷积，得到所述目标路线的S型速度曲线数据。
具体，该目标路线的原始信号y0(k)表示以时间为自变量、所述目标路线的最大速度Vmax为函数值。将该原始信号y0(k)与该第一次卷积窗h1(k)进行第一次卷积，并将其第一次卷积结果y1(k)与第二次卷积窗h2(k)进行第二次卷积，输出得到该目标路线的S 型速度曲线数据y2(k)，如图6所示。本实施例由于规划对象是根据插补周期Ts运行，故，该原始信号y0(k)的大小为
Figure PCTCN2017081605-appb-000005
t0为其时间长度，该原始信号y0(k)的高度为Vmax；该第一次卷积窗h1(k)的大小为
Figure PCTCN2017081605-appb-000006
即t1为第一次卷积窗时间；该第二次卷积窗h2(k)的大小为
Figure PCTCN2017081605-appb-000007
即t2为第二次卷积窗时间。经该二次卷积得到的S型速度曲线信号中的离散速度序列y2(k)。
在另一实施例中，可采用迭代递推的方式得到该S型速度输出曲线，以进一步减少计算量。具体如，利用以下公式6和7对所述目标路线的原始信号y0(k)进行二次卷积得到S型速度曲线信号y2(k)。
Figure PCTCN2017081605-appb-000008
Figure PCTCN2017081605-appb-000009
其中，k为maxh+1到maxh+L的整数，所述maxh为在卷积时原始信号补偿0的个数，所述L为所述二次卷积后的总时间长度t0+t1+t2与插补周期Ts的比值，h1为第一次卷积窗，h2为第二次卷积窗，y1(k)为第一次卷积输出的信号，y2(k)为第二次卷积输出的表示S型速度曲线的信号。
这种迭代递推的方式相对直接二次卷积运算进一步减小了计算量，直接利用第一次卷积的结果计算第二次的卷积值，这种策略用一次循环便实现二次卷积，可以得到输出S型速度曲线的信号y2(k)。
可以理解的是，本发明方法的步骤的描述顺序并不表示其执行的时序顺序，步骤S11(步骤a)虽限于步骤S12(步骤b)和步骤S13(步骤c)描述，但是实际上，步骤S11(步骤a)可在步骤S12(步骤b)和步骤S13(步骤c)之前、之间或之后执行，本发明对该步骤执行顺序不作限定。
本实施例中，采用二次卷积实现S型速度曲线规划，相对于传统的S型速度规划减少了计算量，而且在二次卷积前根据目标路线的唯一和所需满足的卷积时间要求重新计算目标路线可达到的最大速度，进而对目标路线的最大速度进行调整，以利用调整后的最大速度进行二次卷积，避免了目标路线由于位移小无法达到其设定的最大速度的情况，故能够兼容不同路线位移的情况。
请参阅图7，图7是本发明S型速度规划方法另一实施例的流程图。相比于上一实施例，本实施例方法还包括以下步骤：
S71：判断所述目标路线是否可进行S型速度规划。若可以，则执行上述S11，否则结束流程。
具体，可通过判断下述不等式8是否成立，若下述不等式8成立，则判断可进行S型速度规划，否则不可进行S型速度规划。
Figure PCTCN2017081605-appb-000010
其中，公式8中的符号表示的意思如上述实施例描述。
在执行上述S11-S13之后，执行下述S72。
S72：根据插补周期Ts对第一次卷积窗h1和第二次卷积窗h2进行圆整。
由于规划对象按照插补周期运行，故上述第一次卷积窗和第二次卷积窗的时间t1、t2可能不是插补周期Ts的整数倍，此时会存在圆整误差，故本实施例执行下述S72-S74以实现消除该圆整误差。
具体地，该圆整策略为根据插补周期对第一次卷积窗和第二次卷积窗进行向上取整。即，利用下述公式9对第一次卷积窗h1和第二次卷积窗h2进行圆整。
Figure PCTCN2017081605-appb-000011
S73：利用圆整后的第一次卷积窗h1和第二次卷积窗h2重新计算补偿位移Sc。
具体地，利用以下公式10和11对重新计算得到经圆整后的补偿位移Sc。
T1＝h1*Ts；T2＝h2*Ts       (10)；
Sc＝0.5*(Vi+Vf)*(T1+T2)    (11)；
其中，所述T1+T2为二次卷积后从初始速度Vi加速到最大速度Vmax或从最大速度Vmax下降到结束速度Vf的时间。其中，当t1该为在卷积前从初始速度Vi加速到最大速度Vmax的时间，即初始速度Vi小于结束速度Vf时，该T1+T2为二次卷积后从初始速度Vi加速到最大速度Vmax的时间；当该t2为在卷积前从最大速度Vmax下降到结束速度Vf的时间，即初始速度Vi大于结束速度Vf时，该T1+T2为二次卷积后从最大速度Vmax下降到结束速度Vf的时间。
S74：利用所述补偿位移Sc、位移误差ΔS与最大速度V′max之间的关系，计算当位移误差为零时的最大速度V′max以作为所述目标路线的最大速度Vmax。
具体地，匀速运动段最大速度为V′max，故匀速段位移确定，相应的插补总时间也确定。对插补周期的整数倍取整后，会有相应的位移误差ΔS。其中，所述补偿位移Sc、位移误差ΔS与最大速度V′max之间的关系如下：
ΔS＝(S-Sc)-h0*Ts*Vmax    (12)
令上述公式12的位移误差ΔS为零，可得到下述公式13。利用公式13计算得到当位移误差为零时的最大速度V′max。
Figure PCTCN2017081605-appb-000012
其中，t0＝(S-Sc)/Vmax，
Figure PCTCN2017081605-appb-000013
将所述最大速度Vmax作为所述目标路线的最大速度Vmax。即，适当降低达到的最大速度至V′max，使位移无偏差。
利用上述调整后的目标路线的最大速度Vmax执行S14，以实现S型速度规划的圆整，并在执行完S14后，执行S75。
S75：根据所述离散速度序列计算得到对应的若干个插值位置，并根据所述插值位置控制对象在所述目标路线上进行操作。
本实施例中，在执行S14后得到S型速度曲线上的离散速度序列，计算出该序列中每个离散速度值对应的插补位置，具体可通过利用每个速度值计算出相邻插补位置间的插补距离，并累计该插补距离得到该插补位置。在得到插补位置后，控制机床或机器人 手臂以插补周期在目标路线中的插补位置上运行。
可以理解的是，在其他实施例中，步骤S71和步骤S75中的任一个或两个可以被省略，也即不执行。
请参阅图8，图8是本发明S型速度规划方法再一实施例的部分流程图。由于图7所示的圆整方式通过调整速度上升或下降时间T1+T2和最大速度Vmax来实现消除误差，而最大速度降低会影响加工效率。故，区别于图7所示的实施例，本实施例方法不执行上述S72-S74所述的圆整方式，而执行下面步骤S81-S84所述的位移补偿方式，以消除该圆整误差。
S81：根据插补周期Ts对所述第一次卷积窗h1和第二次卷积窗h2进行圆整。
S82：利用圆整后的所述第一次卷积窗h1和第二次卷积窗h2重新计算补偿位移Sc。
S83：利用所述补偿位移Sc与位移误差ΔS间的关系，计算得到位移误差ΔS。
该S81-82具体如上述S72-S73所描述，该S83具体可利用上述公式12计算得到位移误差ΔS。此时，该目标路线的最大速度即为上述S13所得的调整后的最大速度Vmax，该公式12中的最大速度也为S13得到的调整后的最大速度Vmax。
S84：在所述目标路线的原始信号前补充一个
Figure PCTCN2017081605-appb-000014
的离散速度值，以作为新的得到目标路线的原始信号。
通过在原始信号前补充一个
Figure PCTCN2017081605-appb-000015
的离散速度值，使卷积后的总位移为额定值。如图9所示，将原来的目标路线的原始信号y0(k)的在对插补周期取整后的剩余部分的位移补偿到新的目标路线的原始信号y0′(k)的在插补周期取整部分之前，故保证其总位移不变。
结合图9进行具体分析，由于原始信号y0(k)存在不足一个补偿周期的阴影部分，无法进行离散卷积运算。本实施例将不足一个补偿周期的值，根据等效的面积(图中阴影部分面积)，补成一个补偿周期等面积的值，然后补偿到原始信号y0(k)起始的位置得到新的原始信号y0′(k)。经过上面实施例的卷积方法，可把补偿的面积平滑。这种方法，等效于利用卷积窗对于剩余的面积做平均，然后把平均的速度值放在速度上升开始时的区间内，二次卷积的平滑后，能够有效的降低速度波动，把波动控制在有效的范围内，故可得到S型速度曲线比较平滑，二次卷积后的加速度波动会显著地减小。其中，相对的卷积窗越大，平均效果越好，波动越小。
请参阅图10，图10是本发明S型速度规划方法又再一实施例的部分流程图。本实施例中，还包括以下步骤：
S101：获取输入的N个段点坐标。
其中，每相邻两个段点组成一段路线。
在实际操作中，数控系统的机床通常需要在若干段路线进行作业。由于位移限制，一段路线进行S型速度规划时，其临界的速度限制主要在只有一段速度上升或下降的阶段。故，本实施例对每段路线进行前瞻规划，以对每段路线的速度进行限制调整。在调整后，再对该每段路线进行上述实施所述的S型速度规划。
S102：根据所述N个段点的每相邻段点之间的位移、所述N个段点所在总路线的初始速度和结束速度计算得到每个段点的速度V(n)。
例如，N个段点坐标的每相邻段点Q(n)、Q(n+1)组成的路线为L(n)，其中，该n为1到N-1。该L(1)、L(2)、…、L(N-1)构成该N个段点组成的总路线L。该总路线L为以初始速度V(1)为0加速到最大速度，并从最大速度降速到结束速度V(N)为0的路线。 利用N个段点坐标计算得到每段L(n)的位移，从初始速度为0开始，利用每段路线L(n)的位移，可分别计算得到每个段点Q(n)对应的速度V(n)，以使其加速到最大速度后降速到最后段点的结束速度为0。
S103：计算得到每段路线可达到的速度Vf_up。
具体地，假设每段路线L(n)的初始速度为Vi，终点速度为Vf。在给定的加速度A、加加速度Jerk情况下，相比较于梯形加减速，S型加减速比梯形加减速有延迟，延迟时间为A/Jerk。如图11所示的虚线与坐标轴围成的三角形面积Sn，即S型速度规划所走的路线L(n)的距离。
当Vf＞Vi时，
Figure PCTCN2017081605-appb-000016
当Vf＜Vi时，
Figure PCTCN2017081605-appb-000017
相应的在给定Sn(即路线L(n)的位移)，Vi，A，Jerk情况下，Vf有一定的限定。
(a)针对Vf＞Vi情况，解关于Vf的方程，由公式14得到：
Figure PCTCN2017081605-appb-000018
其中，
Figure PCTCN2017081605-appb-000019
由于，
Figure PCTCN2017081605-appb-000020
则Vf一定有实数解。
由于Vf＞Vi，取正值。则
Figure PCTCN2017081605-appb-000021
此时，Vf最大不能超过此值才能做S型速度规划。
(b)针对Vf＜Vi情况，解关于Vf的方程，由公式15得到：
Figure PCTCN2017081605-appb-000022
当
Figure PCTCN2017081605-appb-000023
时，无实数解。此时，在0到Vi的区间内的速度都满足可达条件。
由于Vf＜Vi，则
Figure PCTCN2017081605-appb-000024
该Vf_down为所能降低的最小末速度值，使之能够完成一个S型速度规划。
(c)则根据前面公式推导，根据Vi，S，A，Jerk已知条件，能够完成一个S型速度规划，Vf的限制条件如下公式：
Figure PCTCN2017081605-appb-000025
故，由上述公式17计算得到每段段点可达到的速度Vf_up。
S104：将n从1到N-1依次进行下述前向检验，并将n从N-1到2依次进行下述后向检验。
该前向检验如下：
从n＝1开始，检验V(n+1)是否大于V(n)。
当小于或等于时，直接将n加1并继续上述检验V(n+1)是否大于V(n)，直至该n为N-1，则结束该前向检验。
当大于时，判断当前路线是否可进行S型速度规划，具体可如上述S71所述进行判断。若不可进行S型速度规划，则将降低V(n+1)到上述S103得到的第n+1个段点可达到的速度Vf_up，如图12所示，并将n加1且继续上述检验V(n+1)是否大于V(n)，直至该n为N-1，则结束该前向检验；若可进行S型速度规划，则直接将n加1并继续上述检验V(n+1)是否大于V(n)，直至该n为N-1，则结束该前向检验。
其中，所述当前路线为第n段点与第n+1段点组成的路线。
该后向检验如下：
从n＝N-1开始，检验V(n-1)是否大于V(n)。
当小于或等于时，直接将n减1并继续上述检验V(n-1)是否大于V(n)，直至该n为2，则结束该后向检验。
当大于时，判断当前路线是否可进行S型速度规划，具体可如上述S71所述进行判断。若不可进行S型速度规划，则将降低V(n-1)到上述S103得到的第n-1个段点可达到的速度Vf_up，如图12所示，并将n减1并继续上述检验V(n-1)是否大于V(n)，直至该n为2，则结束该后向检验；若可进行S型速度规划，则直接将n减1并继续上述检验V(n-1)是否大于V(n)，直至该n为2，则结束该后向检验。
其中，所述当前路线为第n段点与第n-1段点组成的路线。
S105：分别将每相邻两个所述段点组成路线作为目标路线。
具体如，将上述路线L(1)、L(2)、…、L(N-1)分别作为上述实施例中的目标路线，并执行上述实施例步骤，以对该目标路线进行S型速度规划。
可以理解的是的，由于在上述前瞻方式的检验中已对是否可S型速度规划进行判断并相应调整，故后续可不执行上述S71重复判断是否可S型速度规划。
请参阅图13，图13是本发明S型速度规划装置一实施例的结构示意图。本实施例中，该装置130包括卷积窗计算模块131、速度获得模块132、速度调整模块133和卷积模块134。
卷积窗计算模块131用于利用目标路线的最大速度Vmax、最大加速度A以及最大加加速度Jerk计算得到第一次卷积窗h1和第二次卷积窗h2；
速度获得模块132用于根据目标路线的位移S以及所需满足的卷积的时间要求，计算得到在所述目标路线实际可达的最大速度Vmax1；
速度调整模块133用于比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小，重新调整所述目标路线的最大速度Vmax；
卷积模块134用于利用第一次卷积窗h1和第二次卷积窗h2对由调整后的目标路线的最大速度Vmax形成的原始信号进行二次卷积，得到所述目标路线的S型速度曲线数据。
可选地，速度调整模块133具体用于比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小；当Vmax1≥Vmax，则维持所述目标路线的最大速度Vmax不变；当 Vmax1＜Vmax，则将所述目标路线的最大速度Vmax调整为Vmax1。
可选地，卷积模块134具体用于利用上述公式6和7对所述目标路线的原始信号y0(k)进行二次卷积得到S型速度曲线信号y2(k)。
可选地，速度获得模块132具体用于利用上述公式3计算得到在所述目标路线实际可达的最大速度Vmax1。
可选地，卷积窗计算模块131具体用于利用上述公式1和2计算得到第一次卷积窗h1和第二次卷积窗h2。
请结合参阅图14，图14是本发明S型速度规划装置另一实施例的结构示意图。本实施例中，该装置140除包括图13所示的模块外，还包括判断模块141、圆整模块142、插值位置模块143、前瞻模块144。
判断模块141用于判断所述目标路线是否可进行S型速度规划，具体可利用上述公式8进行判断。该卷积窗计算模块131具体用于在目标路线可进行S型速度规划是，在执行上一实施例所述功能。
圆整模块142用于根据插补周期Ts对所述第一次卷积窗h1和第二次卷积窗h2进行圆整；利用圆整后的所述第一次卷积窗h1和第二次卷积窗h2重新计算补偿位移Sc；利用所述补偿位移Sc、位移误差ΔS与最大速度V′max之间的关系，计算当位移误差为零时的最大速度V′max以作为所述目标路线的最大速度Vmax。
在另一实施例中，圆整模块142还可不执行上述功能，而用于：根据插补周期Ts对所述第一次卷积窗h1和第二次卷积窗h2进行圆整；利用圆整后的所述第一次卷积窗h1和第二次卷积窗h2重新计算补偿位移Sc；利用所述补偿位移Sc与位移误差ΔS间的关系，计算得到位移误差ΔS；在所述目标路线的原始信号前补充一个
Figure PCTCN2017081605-appb-000026
的离散速度值，以作为新的得到目标路线的原始信号。
插值位置模块143用于根据所述离散速度序列计算得到对应的若干个插值位置，并根据所述插值位置控制对象在所述目标路线上进行操作。
前瞻模块144用于获取输入的N个段点坐标；根据所述N个段点的每相邻段点之间的位移、所述N个段点坐标的初始速度和结束速度计算得到每个段点的速度V(n)；将n从1到N-1依次进行上述前向检验；将n从N到2依次进行下上述后向检验。
上述装置的各个模块可分别执行上述方法实施例中对应步骤，故在此不对各模块进行赘述，详细请参阅以上对应步骤的说明。
请参阅图15，图15是本发明S型速度规划系统一实施例的结构示意图。该S型速度规划系统可以执行上述方法的步骤。相关内容请参见上述方法中的详细说明，在此不再赘叙。
该S型速度规划系统可具体为数控系统、工业机器人等。本实施例中，该S型速度规划系统150包括：处理器151，与处理器151连接的存储器152、驱动电机153，与驱动电机153连接的执行元件154。
该执行元件154也即上述实施例中的规划对象。例如为数控系统的机床、工业机器人的手臂等，该驱动电机153为驱动该机床或机器人的伺服电机等。
存储器152用于存储处理器151执行的计算机指令以及处理器151在进行下述处理过程中的数据，如目标路线的设定最大速度、最大加速度、最大加加速度等。
处理器151执行所述计算机指令，可用于：
利用目标路线的最大速度Vmax、最大加速度A以及最大加加速度Jerk计算得到第一次卷积窗h1和第二次卷积窗h2；
根据目标路线的位移S以及所需满足的卷积的时间要求，计算得到在所述目标路线实际可达的最大速度Vmax1；
比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小，重新调整所述目标路线的最大速度Vmax；
利用第一次卷积窗h1和第二次卷积窗h2对由调整后的目标路线的最大速度Vmax形成的原始信号进行二次卷积，得到所述目标路线的S型速度曲线数据；
根据所述目标路线的S型速度曲线数据向所述驱动电机发送控制指令。
执行元件154用于在所述驱动电机153的驱动下在目标路线上按照所述S型速度曲线进行运作。
可选地，处理器151具体用于：比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小；当Vmax1≥Vmax，则维持所述目标路线的最大速度Vmax不变；当Vmax1＜Vmax，则将所述目标路线的最大速度Vmax调整为Vmax1。
可选地，处理器151具体用于：利用上述公式6和7对所述目标路线的原始信号y0(k)进行二次卷积得到S型速度曲线信号y2(k)。
可选地，处理器151具体用于利用上述公式1、3和4计算得到在所述目标路线实际可达的最大速度Vmax1。
可选地，处理器151具体利用上述公式1和2计算得到第一次卷积窗h1和第二次卷积窗h2。
可选地，处理器151还用于根据插补周期Ts对所述第一次卷积窗h1和第二次卷积窗h2进行圆整；利用圆整后的所述第一次卷积窗h1和第二次卷积窗h2重新计算补偿位移Sc；利用所述补偿位移Sc、位移误差ΔS与最大速度V′max之间的关系，计算当位移误差为零时的最大速度V′max以作为所述目标路线的最大速度Vmax。
可选地，处理器151还用于：根据插补周期Ts对所述第一次卷积窗h1和第二次卷积窗h2进行圆整；利用圆整后的所述第一次卷积窗h1和第二次卷积窗h2重新计算补偿位移Sc；利用所述补偿位移Sc与位移误差ΔS间的关系，计算得到位移误差ΔS；在所述目标路线的原始信号前补充一个
Figure PCTCN2017081605-appb-000027
的离散速度值，以作为新的得到目标路线的原始信号。
可选地，处理器151还用于：获取输入的N个段点坐标，其中，每相邻两个段点组成一段路线；根据所述N个段点的每相邻段点之间的位移、所述N个段点坐标的初始速度和结束速度计算得到每个段点的速度V(n)；将n从1到N-1依次进行上述前向检验；将n从N到2依次进行上述后向检验；分别将每相邻两个所述段点组成路线作为目标路线。
其中，处理器151进一步用于根据上述公式17计算得到每个段点可达到的速度Vf_up。
本发明还提供了一种机器人，请参阅图16，所述机器人160包括控制系统161和机器臂162，所述控制系统161根据上述的S型速度规划方法得到目标路线的S型速度曲线数据，并根据所述S型速度曲线数据控制所述机器臂162运行。
本发明还提供了一种数控机床，所述数控机床170包括数控系统171和机床172，所述数控系统171根据上述的S型速度规划方法得到目标路线的S型速度曲线数据，并根据所述S型速度曲线数据控制所述机床172进行加工。
以上方案，采用二次卷积实现S型速度曲线规划，相对于传统的S型速度规划减少了计算量，而且在二次卷积前根据目标路线的唯一和所需满足的卷积时间要求重新计算 目标路线可达到的最大速度，进而对目标路线的最大速度进行调整，以利用调整后的最大速度进行二次卷积，避免了由于目标路线由于位移小无法达到其设定的最大速度的情况，故能够兼容不同路线位移的情况。
以上所述仅为本发明的实施方式，并非因此限制本发明的专利范围，凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换，或直接或间接运用在其他相关的技术领域，均同理包括在本发明的专利保护范围内。

Claims (27)

  1. 一种S型速度规划方法，其特征在于，包括以下步骤：
    a、利用目标路线的最大速度Vmax、最大加速度A以及最大加加速度Jerk计算得到第一次卷积窗h1和第二次卷积窗h2；
    b、根据目标路线的位移S以及所需满足的卷积的时间要求，计算得到在所述目标路线实际可达的最大速度Vmax1；
    c、比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小，重新调整所述目标路线的最大速度Vmax；
    d、利用第一次卷积窗h1和第二次卷积窗h2对由调整后的目标路线的最大速度Vmax形成的原始信号进行二次卷积，得到所述目标路线的S型速度曲线数据。
  2. 如权利要求1所述的方法，其特征在于，所述步骤c具体包括：
    比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小；
    当Vmax1≥Vmax，则维持所述目标路线的最大速度Vmax不变；
    当Vmax1＜Vmax，则将所述目标路线的最大速度Vmax调整为Vmax1。
  3. 如权利要求1所述的方法，其特征在于，所述步骤d具体包括：
    利用以下公式对所述目标路线的原始信号y0(k)进行二次卷积得到S型速度曲线信号y2(k)；
    Figure PCTCN2017081605-appb-100001
    Figure PCTCN2017081605-appb-100002
    其中，k为maxh+1到maxh+L的整数，所述maxh为卷积信号补偿0的个数，所述L为所述二次卷积后的总时间长度与插补周期的比值，h1为第一次卷积窗，h2为第二次卷积窗，y0(k)表示以时间为自变量、所述目标路线的最大速度Vmax为函数值，y1(k)为第一次卷积输出的信号，y2(k)为第二次卷积输出的表示S型速度曲线的信号。
  4. 如权利要求1所述的方法，其特征在于，所述步骤b具体包括：
    利用以下表示所述目标路线所需满足的卷积的时间要求的公式计算得到在所述目标路线实际可达的最大速度Vmax1；
    Figure PCTCN2017081605-appb-100003
    其中，Vmin＝min(Vi，Vf)，所述Vi为该目标路线的起始速度，所述Vf为该目标路线的结束速度，所述t2为所述第二次卷积窗的时间，所述Sc是补偿位移。
  5. 如权利要求1所述的方法，其特征在于，所述步骤a具体包括：
    利用以下公式计算得到第一次卷积窗的时间t1和第二次卷积窗的时间t2；
    Figure PCTCN2017081605-appb-100004
    其中，所述ΔV为最大速度Vmax与Vmin间的差，所述Vmin＝min(Vi，Vf)，所述Vi为该目标路线的起始速度，所述Vf为该目标路线的结束速度；
    并利用下述公式计算得到第一次卷积窗h1和第二次卷积窗h2；
    Figure PCTCN2017081605-appb-100005
    其中，所述Ts为插补周期。
  6. 如权利要求1所述的方法，其特征在于，在所述步骤c之后，还包括：
    根据插补周期Ts对所述第一次卷积窗h1和第二次卷积窗h2进行圆整；
    利用圆整后的所述第一次卷积窗h1和第二次卷积窗h2重新计算补偿位移Sc；
    利用所述补偿位移Sc、位移误差ΔS与最大速度V′max之间的关系，计算当位移误差为零时的最大速度V′max以作为所述目标路线的最大速度Vmax。
  7. 如权利要求6所述的方法，其特征在于，所述根据插补周期Ts对所述第一次卷积窗h1和第二次卷积窗h2进行圆整，包括：
    利用以下公式对所述第一次卷积窗h1和第二次卷积窗h2进行圆整；
    Figure PCTCN2017081605-appb-100006
    Figure PCTCN2017081605-appb-100007
    其中，t1为第一次卷积窗的时间，t2为第二次卷积窗的时间，Ts为插补周期；
    所述利用圆整后的所述第一次卷积窗h1和第二次卷积窗h2重新计算补偿位移Sc，包括：
    利用以下公式对重新计算得到补偿位移Sc；
    T1＝h1*Ts；T2＝h2*Ts；
    Sc＝0.5*(Vi+Vf)*(T1+T2)；
    其中，所述T1+T2为二次卷积后从初始速度加速到最大速度或从最大速度下降到结束速度的时间；
    所述利用所述补偿位移Sc、位移误差ΔS与最大速度V′max之间的关系，计算当位移误差为零时的最大速度V′max以作为所述目标路线的最大速度Vmax，包括：
    利用以下公式计算得到当位移误差为零时的最大速度V′max；
    Figure PCTCN2017081605-appb-100008
    其中，t0＝(S-Sc)/Vmax，
    Figure PCTCN2017081605-appb-100009
    将所述最大速度V′max作为所述目标路线的最大速度Vmax。
  8. 如权利要求1所述的方法，其特征在于，在所述步骤c之后，还包括：
    根据插补周期Ts对所述第一次卷积窗h1和第二次卷积窗h2进行圆整；
    利用圆整后的所述第一次卷积窗h1和第二次卷积窗h2重新计算补偿位移Sc；
    利用所述补偿位移Sc与位移误差ΔS间的关系，计算得到位移误差ΔS；
    在所述目标路线的原始信号前补充一个
    Figure PCTCN2017081605-appb-100010
    的离散速度值，以作为新的得到目标路线的原始信号。
  9. 如权利要求8所述的方法，其特征在于，所述根据插补周期Ts对所述第一次卷积窗h1和第二次卷积窗h2进行圆整，包括：
    利用以下公式对所述第一次卷积窗h1和第二次卷积窗h2进行圆整；
    Figure PCTCN2017081605-appb-100011
    Figure PCTCN2017081605-appb-100012
    其中，t1为第一次卷积窗的时间，t2为第二次卷积窗的时间，Ts为插补周期；
    所述利用圆整后的所述第一次卷积窗h1和第二次卷积窗h2重新计算补偿位移Sc，包括：
    利用以下公式对重新计算得到补偿位移Sc；
    T1＝h1*Ts；T2＝h2*Ts；
    Sc＝0.5*(Vi+Vf)*(T1+T2)；
    其中，所述T1+T2为二次卷积后从初始速度加速到最大速度或从最大速度下降到结束速度的时间；
    所述利用所述补偿位移Sc与位移误差ΔS间的关系，计算得到位移误差ΔS，包括：
    利用以下公式计算得到位移误差ΔS；
    ΔS＝(S-Sc)-h0*Ts*Vmax；
    其中，t0＝(S-Sc)/Vmax，
    Figure PCTCN2017081605-appb-100013
  10. 如权利要求1至9任一项所述的方法，其特征在于，所述步骤d得到的为S型速度曲线上的离散速度序列；
    所述步骤d之后，还包括：
    根据所述离散速度序列计算得到对应的若干个插值位置，并根据所述插值位置控制对象在所述目标路线上进行操作。
  11. 如权利要求1至9任一项所述的方法，其特征在于，在步骤a之前，还包括：
    判断所述目标路线是否可进行S型速度规划；
    若是，则执行所述步骤a，否则结束流程。
  12. 如权利要求1至9任一项所述的方法，其特征在于，还包括：
    获取输入的N个段点坐标，其中，每相邻两个段点组成一段路线；
    根据所述N个段点的每相邻段点之间的位移、所述N个段点坐标的初始速度和结束速度计算得到每个段点的速度V(n)；
    将n从1到N-1依次进行下述前向检验：检验V(n+1)是否大于V(n)；当大于时，判断当前路线是否可进行S型速度规划；若不可以，则将降低V(n+1)到对应段点可达到的速度；其中，所述当前路线为第n段点与第n+1段点组成的路线；
    将n从N到2依次进行下述后向检验：检验V(n-1)是否大于V(n)；当大于时，判断当前路线是否可进行S型速度规划；若不可以，则将降低V(n-1)到对应段点可达到的速度；其中，所述当前路线为第n段点与第n-1段点组成的路线；
    分别将每相邻两个所述段点组成路线作为目标路线。
  13. 如权利要求12所述的方法，其特征在于，还包括：
    根据以下公式计算得到每个段点可达到的速度Vf_up；
  14. 如权利要求12所述的方法，其特征在于，所述判断当前路线是否可进行S型速度规划，包括：
    判断以下不等式是否成立，若成立，则可进行S型速度规划，否则不可进行S型速度规划；
    Figure PCTCN2017081605-appb-100015
  15. 一种S型速度规划装置，其特征在于，包括：
    卷积窗计算模块，用于利用目标路线的最大速度Vmax、最大加速度A以及最大加加速度Jerk计算得到第一次卷积窗h1和第二次卷积窗h2；
    速度获得模块，用于根据目标路线的位移S以及所需满足的卷积的时间要求，计算得到在所述目标路线实际可达的最大速度Vmax1；
    速度调整模块，用于比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小，重新调整所述目标路线的最大速度Vmax；
    卷积模块，用于利用第一次卷积窗h1和第二次卷积窗h2对由调整后的目标路线的最大速度Vmax形成的原始信号进行二次卷积，得到所述目标路线的S型速度曲线数据。
  16. 一种S型速度规划系统，其特征在于，包括执行元件、驱动电机、处理器和存储器；
    所述存储器用于存储计算机指令以及所述处理器处理的数据；
    所述处理器执行所述计算机指令，用于：
    利用目标路线的最大速度Vmax、最大加速度A以及最大加加速度Jerk计算得到第一次卷积窗h1和第二次卷积窗h2；
    根据目标路线的位移S以及所需满足的卷积的时间要求，计算得到在所述目标路线实际可达的最大速度Vmax1；
    比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小，重新调整所述目标路线的最大速度Vmax；
    利用第一次卷积窗h1和第二次卷积窗h2对由调整后的目标路线的最大速度Vmax形成的原始信号进行二次卷积，得到所述目标路线的S型速度曲线数据；
    根据所述目标路线的S型速度曲线数据向所述驱动电机发送控制指令；
    所述执行元件用于在所述驱动电机的驱动下在目标路线上按照所述S型速度曲线进行运作。
  17. 如权利要求16所述的系统，其特征在于，所述处理器具体用于：
    比较所述实际可达的最大速度Vmax1与所述最大速度Vmax之间的大小；
    当Vmax1≥Vmax，则维持所述目标路线的最大速度Vmax不变；
    当Vmax1＜Vmax，则将所述目标路线的最大速度Vmax调整为Vmax1。
  18. 如权利要求16所述的系统，其特征在于，所述处理器具体用于：
    利用以下公式对所述目标路线的原始信号y0(k)进行二次卷积得到S型速度曲线信号y2(k)；
    Figure PCTCN2017081605-appb-100016
    Figure PCTCN2017081605-appb-100017
    其中，k为maxh+1到maxh+L的整数，所述maxh为卷积信号补偿0的个数，所述L为所述二次卷积后的总时间长度与插补周期的比值，h1为第一次卷积窗，h2为第二次 卷积窗，y0(k)表示以时间为自变量、所述目标路线的最大速度Vmax为函数值，y1(k)为第一次卷积输出的信号，y2(k)为第二次卷积输出的表示S型速度曲线的信号。
  19. 如权利要求16所述的系统，其特征在于，所述处理器具体用于：
    利用以下表示所述目标路线所需满足的卷积的时间要求的公式计算得到在所述目标路线实际可达的最大速度Vmax1；
    Figure PCTCN2017081605-appb-100018
    其中，Vmin＝min(Vi，Vf)，所述Vi为该目标路线的起始速度，所述Vf为该目标路线的结束速度，所述t2为所述第二次卷积窗的时间，所述Sc是补偿位移。
  20. 如权利要求16所述的系统，其特征在于，所述处理器具体用于：
    利用以下公式计算得到第一次卷积窗的时间t1和第二次卷积窗的时间t2；
    Figure PCTCN2017081605-appb-100019
    其中，所述ΔV为最大速度Vmax与Vmin间的差，所述Vmin＝min(Vi，Vf)，所述Vi为该目标路线的起始速度，所述Vf为该目标路线的结束速度；
    并利用下述公式计算得到第一次卷积窗h1和第二次卷积窗h2；
    Figure PCTCN2017081605-appb-100020
    其中，所述Ts为插补周期。
  21. 如权利要求16所述的系统，其特征在于，所述处理器还用于：
    根据插补周期Ts对所述第一次卷积窗h1和第二次卷积窗h2进行圆整；
    利用圆整后的所述第一次卷积窗h1和第二次卷积窗h2重新计算补偿位移Sc；
    利用所述补偿位移Sc、位移误差ΔS与最大速度V′max之间的关系，计算当位移误差为零时的最大速度V′max以作为所述目标路线的最大速度Vmax。
  22. 如权利要求16所述的系统，其特征在于，所述处理器还用于：
    根据插补周期Ts对所述第一次卷积窗h1和第二次卷积窗h2进行圆整；
    利用圆整后的所述第一次卷积窗h1和第二次卷积窗h2重新计算补偿位移Sc；
    利用所述补偿位移Sc与位移误差ΔS间的关系，计算得到位移误差ΔS；
    在所述目标路线的原始信号前补充一个
    Figure PCTCN2017081605-appb-100021
    的离散速度值，以作为新的得到目标路线的原始信号。
  23. 如权利要求16至22任一项所述的系统，其特征在于，所述处理器还用于：
    获取输入的N个段点坐标，其中，每相邻两个段点组成一段路线；
    根据所述N个段点的每相邻段点之间的位移、所述N个段点坐标的初始速度和结束速度计算得到每个段点的速度V(n)；
    将n从1到N-1依次进行下述前向检验：检验V(n+1)是否大于V(n)；当大于时，判断当前路线是否可进行S型速度规划；若不可以，则将降低V(n+1)到对应段点可达到的速度；其中，所述当前路线为第n段点与第n+1段点组成的路线；
    将n从N到2依次进行下述后向检验：检验V(n-1)是否大于V(n)；当大于时，判断当前路线是否可进行S型速度规划；若不可以，则将降低V(n-1)到对应段点可达到的速度；其中，所述当前路线为第n段点与第n-1段点组成的路线；
    分别将每相邻两个所述段点组成路线作为目标路线。
  24. 如权利要求23所述的系统，其特征在于，还包括：
    根据以下公式计算得到每个段点可达到的速度Vf_up；
    Figure PCTCN2017081605-appb-100022
  25. 如权利要求23所述的系统，其特征在于，所述判断所述当前路线是否可进行S型速度规划，包括：
    判断以下等式是否成立，若成立，则可进行S型速度规划，否则不可进行S型速度规划；
    Figure PCTCN2017081605-appb-100023
  26. 一种应用S型速度规划方法的机器人，其特征在于，所述机器人包括控制系统和机器臂，所述控制系统根据权利要求1至14任一项所述的S型速度规划方法得到目标路线的S型速度曲线数据，并根据所述S型速度曲线数据控制所述机器臂运行。
  27. 一种应用S型速度规划方法的数控机床，其特征在于，所述数控机床包括数控系统和机床，所述数控系统根据权利要求1至14任一项所述的S型速度规划方法得到目标路线的S型速度曲线数据，并根据所述S型速度曲线数据控制所述机床进行加工。
PCT/CN2017/081605 2017-04-24 2017-04-24 S型速度规划方法、装置、系统、机器人以及数控机床 WO2018195689A1 (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201780034124.3A CN109313429B (zh) 2017-04-24 2017-04-24 S型速度规划方法、装置、系统、机器人以及数控机床
PCT/CN2017/081605 WO2018195689A1 (zh) 2017-04-24 2017-04-24 S型速度规划方法、装置、系统、机器人以及数控机床

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2017/081605 WO2018195689A1 (zh) 2017-04-24 2017-04-24 S型速度规划方法、装置、系统、机器人以及数控机床

Publications (1)

Publication Number Publication Date
WO2018195689A1 true WO2018195689A1 (zh) 2018-11-01

Family

ID=63918727

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2017/081605 WO2018195689A1 (zh) 2017-04-24 2017-04-24 S型速度规划方法、装置、系统、机器人以及数控机床

Country Status (2)

Country Link
CN (1) CN109313429B (zh)
WO (1) WO2018195689A1 (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113524181B (zh) * 2021-07-09 2023-03-10 东莞市李群自动化技术有限公司 在线速度调整方法、设备、单元、机器人及存储介质
CN114326842B (zh) * 2021-11-25 2024-03-01 广州极飞科技股份有限公司 驱动装置的控制方法及装置、无人设备的控制方法
CN114995118B (zh) * 2022-07-18 2023-08-22 英孚康（浙江）工业技术有限公司 一种抑制过冲和反向的跃度自适应s型速度曲线规划方法
CN116577994B (zh) * 2023-06-25 2024-02-27 英孚康（浙江）工业技术有限公司 冗余容错式非对称s型柔性速度曲线自适应规划方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060229745A1 (en) * 2005-04-08 2006-10-12 Mitsubishi Denki Kabushiki Kaisha Command generating device
CN103777573A (zh) * 2013-12-10 2014-05-07 固高科技(深圳)有限公司 减小轮廓加工误差的方法和系统
CN105710881A (zh) * 2016-03-16 2016-06-29 杭州娃哈哈精密机械有限公司 一种机器人末端连续轨迹规划过渡方法
CN106168790A (zh) * 2016-02-29 2016-11-30 华南理工大学 一种在线改变目标速度和位置的s形加减速控制方法

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101776887B (zh) * 2009-01-13 2013-01-16 新代科技股份有限公司 数字控制装置的控制方法
CN102360198B (zh) * 2011-08-03 2013-08-07 北京配天大富精密机械有限公司 数控系统中操作设备的速度规划方法、装置及数控机床
CN103135501B (zh) * 2013-02-01 2015-10-21 北京配天技术有限公司 基于s型曲线的加减速控制方法和装置及数控机床
CN106682731A (zh) * 2017-01-13 2017-05-17 首都师范大学 卷积神经网络的加速方法及装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060229745A1 (en) * 2005-04-08 2006-10-12 Mitsubishi Denki Kabushiki Kaisha Command generating device
CN103777573A (zh) * 2013-12-10 2014-05-07 固高科技(深圳)有限公司 减小轮廓加工误差的方法和系统
CN106168790A (zh) * 2016-02-29 2016-11-30 华南理工大学 一种在线改变目标速度和位置的s形加减速控制方法
CN105710881A (zh) * 2016-03-16 2016-06-29 杭州娃哈哈精密机械有限公司 一种机器人末端连续轨迹规划过渡方法

Also Published As

Publication number Publication date
CN109313429A (zh) 2019-02-05
CN109313429B (zh) 2021-01-08

Similar Documents

Publication Publication Date Title
CN106168790B (zh) 一种在线改变目标速度和位置的s形加减速控制方法
WO2018195689A1 (zh) S型速度规划方法、装置、系统、机器人以及数控机床
CN108549328B (zh) 自适应速度规划方法及系统
EP2022608B1 (en) Improved blending algorithm for trajectory planning
Sencer et al. High speed cornering strategy with confined contour error and vibration suppression for CNC machine tools
CN109048091B (zh) 激光切割速度规划方法、装置、存储介质及计算机设备
US8774965B2 (en) Method and device for controlling a manipulator
US8294405B2 (en) Method and device for guiding the movement of a moving machine element on a numerically controlled machine
JP2010511919A (ja) 許容差ベースの経路設計と制御の方法
CN107765648B (zh) 一种cnc加工的进给速度规划方法及装置
WO2013140679A1 (ja) 軌跡制御装置
Jin et al. A fine-interpolation-based parametric interpolation method with a novel real-time look-ahead algorithm
JP2010170435A (ja) モーション制御用指令システム、モーション制御用指令方法およびモーション制御システム
CN111331591B (zh) 一种机器人控制方法及装置
JPH05118302A (ja) サーボモータの制御装置
JP2020052810A (ja) 制御装置
JP2018073097A (ja) 工具経路生成装置、工具経路生成方法及び工具経路生成プログラム
KR101918101B1 (ko) 궤도 추적 에러의 최대 진폭을 줄이기 위한 제어기 설계 방법 및 이를 이용한 제어기
US10684594B2 (en) Machine learning device, servo motor controller, servo motor control system, and machine learning method
CN113858213B (zh) 一种用于目标同步的机器人动态轨迹规划方法
JP2014174842A (ja) Ｓ字加減速制御プログラム、動作制御プログラム、記録媒体、コントローラ、ｓ字加減速制御演算方法およびワーク動作制御システム
CN113852321B (zh) 指令生成装置、指令生成方法
JP2002091570A (ja) サーボ制御方法
JP2003076410A (ja) 速度制御装置、速度制御方法およびその方法をコンピュータに実行させるプログラム
JP2737725B2 (ja) ロボット制御装置及び方法

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 17907263

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 17907263

Country of ref document: EP

Kind code of ref document: A1