JP2000148223A5

JP2000148223A5 - Curve interpolation acceleration / deceleration control method and numerical control device

Info

Publication number: JP2000148223A5
Application number: JP1998316446A
Authority: JP
Filing date: 1998-11-06
Publication date: 2005-10-27
Anticipated expiration: 2018-11-06

Description

【特許請求の範囲】
【請求項１】
曲線データを入力する指令入力部と、そのデータから曲率半径と曲率半径極小点を求める曲率評価部と、目標速度設定部と、減速目標点設定部と、加減速設定部とからなる数値制御装置において、以下の手順を踏んで曲線の補間計算をすることを特徴とする曲線補間加減速制御方法。
（１）送り速度データと曲線形状データを含む曲線補間データと指令加速度を入力し、
（２）前記曲線の曲率半径極小点をすべて求め、
（３）前記送り速度と、前記曲率半径極小点での曲率半径と、前記指令加速度とを用いてそれぞれの前記曲率半径極小点での曲率限界速度を求め、
（４）前記曲率半径極小点すべてと前記曲線上の終点を減速目標点として設定し、
（５）前記曲率限界速度を用いて前記減速目標点における目標速度を決定し、
（６）前記減速目標点のうち、前記曲線の終点に向かってある時刻における現在補間点に最も近い点を現在減速目標点とし、
（７）前記現在補間点と前記現在減速目標点との間の直線距離と、前記現在減速目標点における目標速度と、前記指令加速度を用いて前記時刻における補間速度を決定し、
（８）前記曲線補間データと前記補間速度を用いて前記時刻の１制御周期後時刻における補間点を決定し、
（９）前記補間点が前記現在減速目標点に到達するまで（７）、（８）を繰り返し、
前記補間点が前記現在減速目標点に到達し、
（１０）もし前記現在減速目標点が前記曲線の終点でないならば次減速目標点を新たに現在減速目標点に設定し、
（１１）前記補間点が前記曲線の終点に到達するまで前記ステップ（７）〜（１０）を繰す。
【請求項２】
前記現在減速目標点で目標速度を決定する際は、前記現在減速目標点での曲率限界速度と、現在減速目標点と前記曲線の終点に向かって現在減速目標点に最も近い次減速目標点と前記指令加速度から決まる前記現在減速目標点における許容最高初速度とを用いて決定することを特徴とする請求項１記載の曲線補間加減速制御方法。
【請求項３】
前記現在減速目標点で目標速度を決定する際は、以下の手順を踏むことを特徴とする請求項１記載の曲線補間加減速制御方法。
（１）滑らかに接続される連続した複数の前記曲線補間データを入力し、
（２）滑らかに接続される連続した曲線を生成し、
（３）滑らかに接続された各前記曲線の終点が曲率半径極小点でない場合は、前記終点を始点とする滑らかに接続された次曲線上の最初の曲率半径極小点を減速目標点として前記終点と置き換える。
【請求項４】
請求項１ないし３のいずれかに記載の方法を適用したことを特徴とする数値制御装置。
[Claims]
[Claim 1]
A numerical control device consisting of a command input unit for inputting curve data, a curvature evaluation unit for obtaining the radius of curvature and the minimum point of the radius of curvature from the data, a target speed setting unit, a deceleration target point setting unit, and an acceleration / deceleration setting unit. A curve interpolation acceleration / deceleration control method, characterized in that a curve interpolation calculation is performed by following the following procedure.
(1) Input the curve interpolation data including the feed rate data and the curve shape data and the command acceleration, and input the command acceleration.
(2) Find all the minimum points of the radius of curvature of the curve.
(3) Using the feed speed, the radius of curvature at the minimum point of radius of curvature, and the command acceleration, the limit speed of curvature at each minimum point of radius of curvature is obtained.
(4) All the minimum points of the radius of curvature and the end point on the curve are set as deceleration target points.
(5) The target speed at the deceleration target point is determined using the curvature limit speed.
(6) Among the deceleration target points, the point closest to the current interpolation point at a certain time toward the end point of the curve is set as the current deceleration target point.
(7) The linear distance between the current interpolation point and the current deceleration target point, the target speed at the current deceleration target point, and the command acceleration are used to determine the interpolation speed at the time.
(8) Using the curve interpolation data and the interpolation speed, the interpolation point at the time after one control cycle of the time is determined.
(9) Repeat steps (7) and (8) until the interpolation point reaches the current deceleration target point.
The interpolation point reaches the current deceleration target point,
(10) If the current deceleration target point is not the end point of the curve, the next deceleration target point is newly set as the current deceleration target point.
(11) The steps (7) to (10) are repeated until the interpolation point reaches the end point of the curve.
2.
When determining the target speed at the current deceleration target point, the curvature limit speed at the current deceleration target point and the next deceleration target point closest to the current deceleration target point toward the current deceleration target point and the end point of the curve are used. The curve interpolation acceleration / deceleration control method according to claim 1, wherein the maximum permissible initial velocity at the current deceleration target point determined from the command acceleration is used.
3.
The curve interpolation acceleration / deceleration control method according to claim 1, wherein when determining the target speed at the current deceleration target point, the following procedure is performed.
(1) Input a plurality of continuous curve interpolation data that are smoothly connected, and input the curve interpolation data.
(2) Generate a continuous curve that is smoothly connected,
(3) If the end point of each smoothly connected curve is not the minimum point of radius of curvature, the end point is set to the minimum point of radius of curvature on the smoothly connected next curve starting from the end point as the deceleration target point. Replace with.
4.
A numerical control device according to the method according to any one of claims 1 to 3.