JPH07200063A - Munerical control device and method therefor - Google Patents
Munerical control device and method thereforInfo
- Publication number
- JPH07200063A JPH07200063A JP35075093A JP35075093A JPH07200063A JP H07200063 A JPH07200063 A JP H07200063A JP 35075093 A JP35075093 A JP 35075093A JP 35075093 A JP35075093 A JP 35075093A JP H07200063 A JPH07200063 A JP H07200063A
- Authority
- JP
- Japan
- Prior art keywords
- target value
- state
- changed
- moving object
- max
- 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.)
- Pending
Links
Landscapes
- Numerical Control (AREA)
- Control Of Position Or Direction (AREA)
Abstract
Description
【0001】[0001]
【目次】以下の順序で本発明を説明する。 産業上の利用分野 従来の技術 発明が解決しようとする課題 課題を解決するための手段(図1及び図6〜図12) 作用(図1及び図6〜図12) 実施例 (1)全体の構成(図1〜図4) (2)目標値変更(図5) (3)全体の処理手順(図6〜図12) (4)第1の状態における処理(図6及び図7) (5)第2の状態における処理(図6及び図8) (6)第3の状態における処理(図6及び図9) (7)第4の状態における処理(図6及び図10) (8)第5の状態における処理(図6及び図11) (9)第6の状態における処理(図6及び図12) (10)実施例の動作(図1及び図6〜図12) (11)実施例の効果(図1及び図6〜図12) 発明の効果[Table of Contents] The present invention will be described in the following order. Field of Industrial Application Conventional Technology Problem to be Solved by the Invention Means for Solving the Problem (FIGS. 1 and 6 to 12) Action (FIGS. 1 and 6 to 12) Example (1) Overall Configuration (FIGS. 1 to 4) (2) Target value change (FIG. 5) (3) Overall processing procedure (FIGS. 6 to 12) (4) Processing in first state (FIGS. 6 and 7) (5) ) Processing in the second state (FIGS. 6 and 8) (6) Processing in the third state (FIGS. 6 and 9) (7) Processing in the fourth state (FIGS. 6 and 10) (8) Processing in state 5 (FIGS. 6 and 11) (9) Processing in state 6 (FIGS. 6 and 12) (10) Operation of the embodiment (FIGS. 1 and 6 to 12) (11) Embodiment Effects (FIGS. 1 and 6 to 12) Effects of the invention
【0002】[0002]
【産業上の利用分野】本発明は数値制御装置及びその方
法に関し、特に目標値変更の容易な目標値生成装置及び
その方法に適用して好適なものである。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a numerical control device and method thereof, and is particularly suitable for application to a target value generation device and method thereof whose target value can be easily changed.
【0003】[0003]
【従来の技術】従来この種の数値制御装置として、目標
値に基づく目標軌道を生成した後に当該目標値の変更が
なされた場合において、当該目標値変更後の目標値に基
づいて目標軌道を再度全体として生成し直した後、移動
対象の移動を開始する方法によるものが一般的に用いら
れている。2. Description of the Related Art Conventionally, as a numerical control device of this type, when a target trajectory is changed after the target trajectory is generated based on the target value, the target trajectory is re-established based on the target value after the target value is changed. A method of starting the movement of the movement target after regenerating it as a whole is generally used.
【0004】[0004]
【発明が解決しようとする課題】ところで従来のこの種
の数値制御装置において、移動対象が移動制御されてい
る途中に目標値の変更がなされた場合は、当該変更後の
目標値に基づく目標軌道全体を1クロツク時間内で再度
生成し直す必要があり、この目標軌道を生成するための
演算処理が1クロツク時間内に終わらないおそれがあ
る。またこれとは逆に、この演算速度はデイジタル制御
における1クロツク時間の限界を定めることになるた
め、演算処理の高速化を図るときの障害になるおそれが
ある。By the way, in the conventional numerical control apparatus of this type, when the target value is changed while the movement target is being controlled, the target trajectory based on the changed target value. It is necessary to regenerate the whole device within one clock time, and there is a possibility that the arithmetic processing for generating this target trajectory will not be completed within one clock time. On the contrary, this calculation speed limits the one clock time in the digital control, which may be an obstacle to speeding up the calculation process.
【0005】本発明は以上の点を考慮してなされたもの
で、移動対象が移動制御されている間に目標値変更がな
された場合に、比較的簡単に当該目標値変更に対応した
処理をすることができる数値制御装置及びその方法を提
案しようとするものである。The present invention has been made in consideration of the above points, and when the target value is changed while the moving object is controlled to move, the process corresponding to the change of the target value can be performed relatively easily. The present invention intends to propose a numerical control device and a method therefor.
【0006】[0006]
【課題を解決するための手段】かかる課題を解決するた
め本発明においては、設定された目標値Pm によつて表
される目標位置に対して移動対象を移動制御する数値制
御装置1において、移動対象が移動制御されている間に
目標値Pm の変更がなされた場合に、変更後の目標値P
m ′に基づいて移動対象の現在位置Pk から1クロツク
経過後の位置信号Pk+1 を順次生成する目標値生成装置
2と、目標値生成装置2から送出される位置信号Pk を
符号部4から送出される出力信号Yk と一致させること
によつて得られる制御信号Uk に基づいてサーボ駆動す
るサーボ制御部3とを備えるようにする。In order to solve such a problem, according to the present invention, in a numerical controller 1 for controlling the movement of a moving object with respect to a target position represented by a set target value P m , When the target value P m is changed while the moving object is being controlled for movement, the changed target value P m
code a target value generating unit 2, the position signals P k transmitted from the target value generator 2 for sequentially generating position signals P k + 1 from the current position P k 1 clock after the moving object based on m ' And a servo control unit 3 that servo-drives based on a control signal U k obtained by matching the output signal Y k sent from the unit 4.
【0007】また本発明においては、設定された目標値
Pm によつて表される目標位置に対して移動対象を移動
制御する数値制御装置1において、移動対象が移動制御
されている間に目標値Pm の変更がなされた場合に、変
更後の目標値Pm ′に基づいて移動対象の現在位置Pk
から1クロツク経過後の位置を順次生成し、移動対象の
減速時においては、移動対象の停止位置と変更後の目標
値Pm ′とのずれを演算した後に当該ずれを小さくする
操作を繰り返すようにする。Further, according to the present invention, in the numerical controller 1 for controlling the movement of the moving object with respect to the target position represented by the set target value P m , the target is controlled while the moving object is being controlled. When the value P m is changed, the current position P k of the movement target is calculated based on the changed target value P m ′.
The position after one clock has been sequentially generated, and when decelerating the moving object, the deviation between the stop position of the moving object and the changed target value P m ′ is calculated and then the operation for reducing the deviation is repeated. To
【0008】さらに本発明においては、設定された目標
値Pm によつて表される目標位置に対して移動対象を移
動制御する数値制御方法において、移動対象が移動制御
されている間に目標値Pm の変更がなされた場合に、変
更後の目標値Pm ′に基づいて移動対象の現在位置Pk
から1クロツク経過後の位置信号Pk+1 を順次生成し、
目標値生成装置1から送出される位置信号Pk を符号部
4から送出される出力信号Yk と一致させることによつ
て得られる制御信号Uk に基づいてサーボ駆動するよう
する。Further, in the present invention, in the numerical control method for controlling the movement of the moving object with respect to the target position represented by the set target value P m , the target value is controlled while the moving object is being controlled. When P m is changed, the current position P k of the moving object is changed based on the changed target value P m ′.
Position signals P k + 1 after one clock has elapsed are sequentially generated,
Servo drive is performed based on a control signal U k obtained by matching the position signal P k sent from the target value generation device 1 with the output signal Y k sent from the encoding unit 4.
【0009】[0009]
【作用】変更後の最終目標値Pm ′に基づいて移動対象
の目標値Pk から1クロツク経過後の目標値Pk+1 を順
次生成し、その際、移動対象の減速時においては、移動
対象の停止位置と変更後の最終目標値Pm ′とのずれを
演算した後にこのずれを小さくする操作を繰り返すよう
にする。The target value P k + 1 after one clock has elapsed is sequentially generated from the target value P k of the moving object based on the changed final target value P m ′. At this time, when decelerating the moving object, After calculating the deviation between the stop position of the moving object and the changed final target value P m ′, the operation of reducing the deviation is repeated.
【0010】[0010]
【実施例】以下図面について、本発明の一実施例を詳述
する。DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the present invention will be described in detail below with reference to the drawings.
【0011】(1)全体の構成 図1において、1は全体としてデイジタル位置制御サー
ボ装置の概略構成を示し、目標値生成装置2が外部から
与えられた最終的な目標値(以下、最終目標値という)
Pm の信号に基づいて時刻kにおける目標値Pk を生成
し、当該目標値Pk の信号をサーボコントローラ3に送
出する。また目標値生成装置2は、外部から与えられた
目標値変更フラグch flag の値に基づいて目標値変更が
要求されているか否かを判断するようになされている。(1) Overall Configuration In FIG. 1, reference numeral 1 generally indicates a schematic configuration of a digital position control servo device, in which a target value generator 2 externally gives a final target value (hereinafter, a final target value). Say)
It generates a target value P k at time k based on a signal P m, and sends a signal of the target value P k to the servo controller 3. Further, the target value generation device 2 is configured to judge whether or not the target value change is requested based on the value of the target value change flag ch flag given from the outside.
【0012】サーボコントローラ3は、目標値生成装置
2から得られる目標値Pk の信号をエンコーダ4から得
られる出力信号Yk と一致させるように、PID制御則
等に基づいて制御信号Uk を生成し、当該制御信号Uk
に基づいてモータ5を回転駆動させる。その際、モータ
5の駆動状態は信号としてエンコーダ4に送出され、当
該エンコーダ4において出力信号Yk として送出され
る。The servo controller 3 sets the control signal U k based on the PID control rule or the like so that the signal of the target value P k obtained from the target value generating device 2 matches the output signal Y k obtained from the encoder 4. Generate the relevant control signal U k
The motor 5 is rotationally driven based on At that time, the drive state of the motor 5 is sent as a signal to the encoder 4, and is sent as an output signal Y k in the encoder 4.
【0013】モータ5は、目標値Pk に対応して回転
し、例えば、ロボツトのアーム(図示せず)の先端に有
し、当該アームにより移動制御されるもの(以下、移動
対象という)(図示せず)が、目標値Pk に対応して開
始位置P0 から最終目標値Pmに至るまで移動制御する
ようになされている。また、モータ5は最大速度Vmax
及び最大加速度Amax 等についてのモータ定格を満足す
るようになされている。The motor 5 rotates corresponding to the target value P k , has, for example, a tip of an arm (not shown) of the robot, and is controlled to move by the arm (hereinafter referred to as a moving object) ( (Not shown) controls the movement from the start position P 0 to the final target value P m corresponding to the target value P k . The motor 5 has a maximum speed V max.
And the motor ratings for maximum acceleration A max and the like are satisfied.
【0014】図2(A)に示すように、目標軌道L1
は、時間0における開始位置P0 から時間k3 における
最終目標値Pm までの目標値Pk の列すなわち移動対象
の移動軌跡を表した曲線で示される。この目標軌道L1
は、時間0から時間k1 までの加速部L1A、時間k1
から時間k2 までの定速部L1B、及び時間k2 から時
間k3 までの減速部L1Cの3つの部分から構成されて
いる。As shown in FIG. 2A, the target trajectory L1
Is represented by a curve representing a sequence of target values P k from the start position P 0 at time 0 to the final target value P m at time k 3, that is, a movement trajectory of the moving object. This target trajectory L1
Is the acceleration unit L1A from time 0 to time k 1 , time k 1
To a time k 2 and a constant speed portion L1B and a speed reduction portion L1C from a time k 2 to a time k 3 .
【0015】また、図2(B)に示すように、L2は目
標軌道L1に対応する加速度直線を示し、移動対象はサ
ーボコントローラ3によつて移動制御されることによ
り、加速部L2Aにおいて最大加速度Amax に基づいて
最大速度Vmax になるまで加速(以下、最大加速とい
う)され、続いて定速部L2Bにおいて最大速度Vmax
のまま維持され、さらに減速部L2Cにおいて最大加速
度Amax に対応した負の加速度に基づいて減速(以下、
最大減速という)されるようになされている。Further, as shown in FIG. 2B, L2 indicates an acceleration straight line corresponding to the target trajectory L1, and the movement target is controlled to move by the servo controller 3 so that the maximum acceleration in the acceleration unit L2A. The vehicle is accelerated (hereinafter referred to as maximum acceleration) based on A max until it reaches the maximum speed V max , and subsequently, the maximum speed V max is obtained in the constant speed portion L2B.
In the deceleration unit L2C, deceleration based on the negative acceleration corresponding to the maximum acceleration A max (hereinafter,
The maximum deceleration is called).
【0016】その際、これらの各状態における継続時間
は、最終目標値Pm 及び最大速度Vmax 、最大加速度A
max のそれぞれの値により決まることになる。ここで、
最大速度Vmax における移動対象を最大減速してから速
度が0になるまで(時間k2 から時間k3 まで)に、目
標値Pk が移動する距離をPstopとする。At this time, the duration in each of these states is the final target value P m, the maximum velocity V max , and the maximum acceleration A.
It will be determined by each value of max . here,
The distance traveled by the target value P k from the maximum deceleration of the moving object at the maximum speed V max until the speed becomes 0 (from time k 2 to time k 3 ) is P stop .
【0017】図3の状態遷移図に示すように、開始位置
P0 から最終目標値Pm までの目標値Pk の移動距離が
充分に長い場合には、移動対象が最大加速度Amax に基
づいて加速された後最大速度Vmax に達する前に目標値
Pk が最終目標値Pm に到達せず、このため移動対象は
第1の状態(状態1)、第2の状態(状態2)及び第3
の状態(状態3)と順次遷移し得る。As shown in the state transition diagram of FIG. 3, when the moving distance of the target value P k from the starting position P 0 to the final target value P m is sufficiently long, the moving object is based on the maximum acceleration A max . The target value P k does not reach the final target value P m before reaching the maximum speed V max after being accelerated, and therefore the moving target is in the first state (state 1) and the second state (state 2). And the third
The state (state 3) can be sequentially transited.
【0018】すなわち、状態1は移動対象が最大加速さ
れ、最大速度Vmax に達するまで(時間k1 の位置)の
状態を示し、続いて状態2は移動対象が最高速度Vmax
のまま維持され、当該移動対象に対応する目標値Pk が
Pm −Pstopの位置に達するまで(時間k2 の位置)の
状態を示し、さらに状態3は移動対象が最大減速され、
速度が0になるまで(時間k3 の位置)の状態を示す。That is, the state 1 shows the state in which the moving object is maximally accelerated and reaches the maximum velocity V max (at the position of the time k 1 ), and subsequently, the state 2 shows the moving object having the maximum velocity V max.
The state is maintained until the target value P k corresponding to the moving object reaches the position of P m −P stop (position of time k 2 ), and state 3 further decelerates the moving object to the maximum,
The state is shown until the speed becomes 0 (position at time k 3 ).
【0019】また、開始位置P0 から最終目標値Pm ま
での目標値Pk の移動距離が短い場合には、移動対象が
最大加速度Amax に基づいて加速された後最大速度V
max に達する前に目標値Pk が最終目標値Pm に到達す
ることにより、移動対象は最大速度Vmax に達する前に
減速が開始されることが必要になり、状態1から状態3
へと遷移することになる。すなわち、まず状態1におい
て、移動対象は最大加速度Amax に基づいて加速され、
目標値Pk が(Pm −P0 )/2の位置に達すると同時
に状態3に移つて最大減速が開始される。Further, when the moving distance of the target value P k from the start position P 0 to the final target value P m is short, the moving object is accelerated based on the maximum acceleration A max, and then the maximum speed V is reached.
Since the target value P k reaches the final target value P m before reaching max , it becomes necessary for the moving object to start deceleration before reaching the maximum speed V max.
Will transition to. That is, first, in the state 1, the moving object is accelerated based on the maximum acceleration A max ,
Moves connexion maximum deceleration is initiated to a target value P k is (P m -P 0) / 2 of the reaches the position at the same time the state 3.
【0020】さらに、上述の場合における状態1、状態
2及び状態3と順次遷移する方向と逆方向についても移
動対象を遷移することができ、この場合における加速部
を第4の状態(状態4)、定速部を第5の状態(状態
5)、減速部を第6の状態(状態6)として図3に示す
状態遷移図と対応する状態遷移図を図4に示す。図4に
おいて、状態3から状態4への遷移、及び状態6から状
態1への遷移については、最終目標値Pm が変更された
ことにより、移動対象を再度加速する必要がある場合に
起こり得ることになる。Further, the moving object can be transited in the direction opposite to the direction in which the state 1, the state 2 and the state 3 are sequentially transited in the above-mentioned case, and in this case, the accelerating portion is moved to the fourth state (state 4). FIG. 4 shows a state transition diagram corresponding to the state transition diagram shown in FIG. 3 in which the constant speed portion is in the fifth state (state 5) and the deceleration portion is in the sixth state (state 6). In FIG. 4, the transition from the state 3 to the state 4 and the transition from the state 6 to the state 1 can occur when the moving target needs to be accelerated again due to the change of the final target value P m. It will be.
【0021】(2)目標値変更 最終目標値Pm がPm ′に変更された場合において、目
標値生成装置2は当該変更後の最終目標値Pm ′に基づ
いて状態を遷移させた後、目標値変更前の各状態におけ
る操作と同様の操作を継続することにより、当該操作に
対応する時刻kの目標値Pk を生成するようにする。(2) Change of target value In the case where the final target value P m is changed to P m ′, the target value generating device 2 changes the state based on the changed final target value P m ′. By continuing the same operation as the operation in each state before the change of the target value, the target value P k of the time k corresponding to the operation is generated.
【0022】第1に移動対象が移動制御されている途中
に最終目標値Pm がPm ′に変更される場合(以下、目
標値変更という)において、当該変更後の最終目標値P
m ′が当初の最終目標値Pm よりも大きい値の場合につ
いて説明する。First, when the final target value P m is changed to P m ′ while the moving object is being controlled to move (hereinafter, referred to as target value change), the final target value P after the change is changed.
A case where m ′ is a value larger than the initial final target value P m will be described.
【0023】目標値変更が状態1または状態2において
された場合は、目標値生成装置2は最終目標値Pm を変
更後の最終目標値Pm ′に置き換えた後、変更前と同様
に各状態での操作を継続することによつて目標値Pk が
変更後の最終目標値Pm ′に到達する。この場合、状態
1から状態3に遷移する位置(Pm −P0 )/2、もし
くは状態2から状態3に遷移する位置Pm −Pstopを、
それぞれ(Pm ′−P0 )/2、Pm ′−Pstopに置き
換えるようにする。When the target value is changed in the state 1 or the state 2, the target value generating device 2 replaces the final target value P m with the changed final target value P m ′, and then performs the same process as before the change. By continuing the operation in the state, the target value P k reaches the changed final target value P m ′. In this case, the position (P m -P 0 ) / 2 where the state 1 transits to the state 3 or the position P m -P stop where the state 2 transits to the state 3 is
They are respectively replaced with (P m ′ −P 0 ) / 2 and P m ′ −P stop .
【0024】また、目標値変更が状態3においてされた
場合は、開始位置P0 から変更後の最終目標値Pm ′ま
での目標値Pk の移動距離が変更前に比べて伸長するに
もかかわらず、移動対象が最大減速されるために、目標
値Pk が変更後の最終目標値Pm ′に到達できなくなる
おそれがある。このため、目標値生成装置2は再度状態
1に遷移して移動対象を最大加速することにより、目標
値Pk が変更後の最終目標値Pm ′に到達し得るように
する。Further, when the target value is changed in the state 3, the moving distance of the target value P k from the start position P 0 to the changed final target value P m ′ becomes longer than that before the change. Nevertheless, the target value P k may not reach the changed final target value P m ′ because the moving object is decelerated to the maximum. Therefore, the target value generation device 2 again transits to the state 1 and accelerates the moving object to the maximum, so that the target value P k can reach the changed final target value P m ′.
【0025】図4において、状態3から状態1への遷
移、及び状態6から状態4への遷移については、最終目
標値Pm が変更されたことにより、移動対象を再度加速
する必要がある場合に起こり得ることになる。In FIG. 4, regarding the transition from state 3 to state 1 and the transition from state 6 to state 4, it is necessary to accelerate the moving object again because the final target value P m is changed. Will happen to you.
【0026】その際、目標値変更に伴つて状態3から状
態1に遷移する場合には、開始位置P0 も変更する必要
があり、従つて図5(A)に示す目標軌道L3におい
て、時刻kにおける目標値Pk が点RA の位置にあると
きに最終目標値Pm がPm ′に変更された場合には、所
定の点QA の位置を新たな開始位置P0 ′とする。ここ
で、図5(B)に示すように、加速度直線L5上の点R
B は、図5(A)に示す目標軌道L3上の点RA に対応
しており、時刻kにおける速度Vk のときの位置を表し
ている。At this time, when the state 3 is changed to the state 1 in accordance with the change of the target value, the start position P 0 also needs to be changed, and accordingly, the time on the target trajectory L3 shown in FIG. When the final target value P m is changed to P m ′ when the target value P k at k is at the position of the point R A , the position of the predetermined point Q A is set as the new start position P 0 ′. . Here, as shown in FIG. 5B, a point R on the acceleration straight line L5
B corresponds to the point R A on the target trajectory L3 shown in FIG. 5A, and represents the position at the speed V k at the time k .
【0027】図5(B)において、新たな開始位置
P0 ′を表す点QA に対応した点QB の位置を設定する
にあたつて、状態1における最大加速度Amax の値が常
に一定であることにより、最大加速した場合を示す加速
度直線L6は、点RB の位置を通らなければならず、従
つてこの加速度直線L6と時間軸との交点を点QB の位
置と設定することにする。In setting the position of the point Q B corresponding to the point Q A representing the new start position P 0 ′ in FIG. 5B, the value of the maximum acceleration A max in the state 1 is always constant. Therefore, the acceleration straight line L6 indicating the case of maximum acceleration has to pass through the position of the point R B , and accordingly, the intersection of the acceleration straight line L6 and the time axis should be set as the position of the point Q B. To
【0028】その結果、図5(A)に示すように、点Q
A の位置から最大加速した場合を示す目標軌道L4は、
点RA の位置において目標軌道L3と入れ代わることに
より、目標値Pk は変更後の最終目標値Pm ′に到達す
ることができる。As a result, as shown in FIG.
The target trajectory L4 showing the case of maximum acceleration from the position A is
By replacing the target trajectory L3 at the position of the point R A , the target value P k can reach the changed final target value P m ′.
【0029】上述のように、最終目標値Pm が変更され
る毎に新たな開始位置を設定して、再度状態1における
操作をすることにより、目標値Pk が(Pm −P0 ′)
/2に達した場合は状態3に遷移することができ、また
目標値Pk が(Pm −P0 ′)/2に達する前に移動対
象の速度が最大速度Vmax に達した場合は状態2に遷移
することができる。従つて、変更後の最終目標値Pm ′
に対応した目標軌道を生成することができる。As described above, by setting a new start position each time the final target value P m is changed and performing the operation in the state 1 again, the target value P k becomes (P m -P 0 ′). )
When it reaches / 2, it is possible to transit to the state 3, and when the velocity of the moving object reaches the maximum velocity V max before the target value P k reaches (P m -P 0 ′) / 2, It is possible to transit to state 2. Therefore, the changed final target value P m ′
It is possible to generate a target trajectory corresponding to.
【0030】第2に目標値変更において、変更後の最終
目標値Pm ′が当初の最終目標値Pm よりも小さい値の
ときについて説明する。目標値Pk が、変更後の最終目
標値Pm ′に対して最大減速を開始しなければならない
位置に到達していない場合は、目標値生成装置2は最終
目標値Pm をPm ′に置き換えた後、変更前と同様に各
状態での操作を継続することにより、目標値Pk が当該
変更後の最終目標値Pm ′に到達し得るようにする。Secondly, in the case of changing the target value, the case where the changed final target value P m ′ is smaller than the initial final target value P m will be described. When the target value P k has not reached the position where the maximum deceleration should be started with respect to the changed final target value P m ′, the target value generation device 2 sets the final target value P m to P m ′. After the replacement, the target value P k can reach the final target value P m ′ after the change by continuing the operation in each state as before the change.
【0031】この場合、変更後の最終目標値Pm ′に対
して目標値Pk が最大減速を開始しなければならない位
置は、状態1において目標値変更がされた場合は
(Pm ′−P0 )/2の位置であり、状態2において目
標値変更がされた場合はPm ′−Pstopの位置である。In this case, the position where the target value P k has to start the maximum deceleration with respect to the changed final target value P m ′ is (P m ′ − when the target value is changed in the state 1). The position is P 0 ) / 2, and is the position of P m ′ -P stop when the target value is changed in the state 2.
【0032】また、目標値Pk が、変更後の最終目標値
Pm ′に対して上述に示すような最大減速を開始しなけ
ればならない位置を越えているときに目標値変更がされ
た場合は、開始位置P0 から変更後の最終目標値Pm ′
までの目標値Pk の移動距離が変更前に比べて短縮する
にもかかわらず、移動対象が減速されないために、目標
値Pk が変更後の最終目標値Pm ′を超えてしまうおそ
れがある。このため、目標値変更がされた際、目標値生
成装置2は直ちに状態3に遷移して最大減速することに
より、目標値Pk が変更後の最終目標値Pm ′を超え得
ないようにする。Further, when the target value P k is changed when the target value P k exceeds the position where the maximum deceleration as described above has to be started with respect to the changed final target value P m ′. Is the final target value P m ′ after the change from the start position P 0
Although the moving distance of the target value P k up to is shorter than that before the change, since the moving object is not decelerated, the target value P k may exceed the changed final target value P m ′. is there. Therefore, when the target value is changed, the target value generation device 2 immediately transits to the state 3 and performs maximum deceleration, so that the target value P k cannot exceed the changed final target value P m ′. To do.
【0033】その際、移動対象を最大減速しても目標値
Pk が変更後の最終目標値Pm ′を超えてしまう場合が
あることから、この場合には当該変更後の最終目標値P
m ′を超えた位置で移動対象を停止させ、当該停止した
位置を新たな開始位置P0 ′として、状態3から状態4
へと逆方向の遷移を開始させるようにする。At this time, the target value P k may exceed the changed final target value P m ′ even if the moving object is decelerated to the maximum. Therefore, in this case, the changed final target value P k.
The moving object is stopped at a position exceeding m ′, and the stopped position is set as a new start position P 0 ′.
Start the transition in the opposite direction to.
【0034】(3)全体の処理手順 図6〜図12に示す目標値生成装置2における処理手順
について以下のように説明する。時刻kにおける目標値
Pk 及び速度Vk の関係式は、速度Vk を定速時におけ
る1クロツク間に移動する距離とみなして、Pk =P
k-1 +Vk と表すことにする。また、最大加速時におい
ては、最大加速度Amax を1クロツク間に移動する速度
とみなして、Vk+1 =Vk +Amax と表すことにする。(3) Overall Processing Procedure The processing procedure in the target value generating device 2 shown in FIGS. 6 to 12 will be described as follows. The relational expression between the target value P k and the speed V k at the time k is regarded as P k = P, where the speed V k is regarded as the distance moved during one clock at a constant speed.
It will be expressed as k-1 + V k . Further, at the time of maximum acceleration, the maximum acceleration A max is regarded as the velocity moving in one clock, and is expressed as V k + 1 = V k + A max .
【0035】また、state は状態を表し、例えばstate
=1は状態1であることを示すものとする。また、目標
値の変更が要求されている場合は、目標値変更フラグch
flag が1になるものとする。また、stopは終了を表
し、stop=1は移動対象が移動を終了したことを示すも
のとする。Further, state represents a state, for example, state
= 1 indicates the state 1. If the target value change is requested, the target value change flag ch
It is assumed that flag becomes 1. Also, stop represents the end, and stop = 1 represents that the movement target has finished the movement.
【0036】目標値生成装置2において、前の時刻の目
標値Pk-1 から新しい目標値Pk が生成され、さらに、
前の時刻の速度Vk から新しい速度Vk+1 が生成される
ようになされている。ここで、目標値Pk は上述に示す
式Pk =Pk-1 +Vk に基づいて得られることにより、
まずPk-1 及びVk からPk を生成し、次に移動対象が
遷移する状態に対応する操作をすることによつて速度V
k+1 を得るようにする。In the target value generating device 2, a new target value P k is generated from the target value P k-1 at the previous time, and further,
A new speed V k + 1 is generated from the speed V k at the previous time. Here, the target value P k is obtained based on the equation P k = P k−1 + V k shown above,
First P k-1 and V k generates P k from, then by that mobile object is an operation corresponding to the state transition connexion speed V
Try to get k + 1 .
【0037】以下図6に示すように全体のフローチヤー
トについて説明する。図1の構成において、目標値生成
装置2に外部から最終目標値Pm の信号が与えられたと
き、目標値生成装置2は図6に示す処理手順SP1に入
る。目標値生成装置2は、ステツプSP2においてPk
=Pk-1 +Vk の式を用いて目標値Pk-1 と速度Vk か
ら目標値Pk を生成する。The entire flow chart will be described below with reference to FIG. In the configuration of FIG. 1, when the signal of the final target value P m is given to the target value generating device 2 from the outside, the target value generating device 2 enters the processing procedure SP1 shown in FIG. The target value generator 2 determines P k in step SP2.
= P k-1 + V k is used to generate the target value P k from the target value P k -1 and the velocity V k .
【0038】続いてステツプSP3に移つて、目標値生
成装置2は状態1であるか否かを判断し、肯定結果が得
られたときには、目標値生成装置2は図7に示す第1の
状態における処理RT1に入る。これに対してステツプ
SP3において否定結果が得られると、目標値生成装置
2はステツプSP4に移る。Subsequently, in step SP3, it is determined whether or not the target value generating device 2 is in the state 1, and when a positive result is obtained, the target value generating device 2 is in the first state shown in FIG. The process RT1 is started. On the other hand, if a negative result is obtained in step SP3, the target value generation device 2 moves to step SP4.
【0039】このステツプSP4において、目標値生成
装置2は状態2であるか否かを判断し、肯定結果が得ら
れたときには、目標値生成装置2は図8に示す第2の状
態における処理RT2に入る。これに対してステツプS
P4において否定結果が得られると、目標値生成装置2
はステツプSP5に移る。At this step SP4, the target value generating device 2 judges whether or not it is in the state 2, and when a positive result is obtained, the target value generating device 2 has the processing RT2 in the second state shown in FIG. to go into. On the other hand, step S
If a negative result is obtained in P4, the target value generation device 2
Moves to step SP5.
【0040】このステツプSP5において、目標値生成
装置2は状態3であるか否かを判断し、肯定結果が得ら
れたときには、目標値生成装置2は図9に示す第3の状
態における処理RT3に入る。これに対してステツプS
P5において否定結果が得られると、目標値生成装置2
はステツプSP6に移る。At this step SP5, the target value generation device 2 judges whether or not it is in the state 3, and when a positive result is obtained, the target value generation device 2 causes the processing RT3 in the third state shown in FIG. to go into. On the other hand, step S
If a negative result is obtained in P5, the target value generation device 2
Moves to step SP6.
【0041】このステツプSP6において、目標値生成
装置2は状態4であるか否かを判断し、肯定結果が得ら
れたときには、目標値生成装置2は図10に示す第4の
状態における処理RT4に入る。これに対してステツプ
SP6において否定結果が得られると、目標値生成装置
2はステツプSP7に移る。At this step SP6, the target value generating device 2 judges whether or not it is in the state 4, and when a positive result is obtained, the target value generating device 2 has the processing RT4 in the fourth state shown in FIG. to go into. On the other hand, if a negative result is obtained in step SP6, the target value generation device 2 moves to step SP7.
【0042】このステツプSP7において、目標値生成
装置2は状態5であるか否かを判断し、肯定結果が得ら
れたときには、目標値生成装置2は図11に示す第5の
状態における処理RT5に入る。これに対してステツプ
SP7において否定結果が得られると、目標値生成装置
2は図12に示す第6の状態における処理RT6に入
る。At this step SP7, the target value generation device 2 judges whether or not it is in state 5, and when a positive result is obtained, the target value generation device 2 causes the process RT5 in the fifth state shown in FIG. to go into. On the other hand, if a negative result is obtained in step SP7, the target value generation device 2 enters processing RT6 in the sixth state shown in FIG.
【0043】このように目標値生成装置2は各状態にお
ける処理操作をそれぞれについてした後、ステツプSP
9に移つてstop=1であるか否かを判断し、否定結果が
得られたときは、目標値生成装置2はステツプSP10
に移つてk=k+1とした後、再度上述のステツプSP
2に戻つて次の時刻の操作を開始する。これに対してス
テツプSP9において、目標値生成装置2が肯定結果を
得ると、そのままステツプSP11に移つて当該処理手
順を終了する。In this way, the target value generating device 2 performs the processing operation in each state, and then the step SP
In step 9, it is determined whether stop = 1, and if a negative result is obtained, the target value generation device 2 proceeds to step SP10.
After setting to k = k + 1, the above-mentioned step SP is performed again.
Return to 2 and start the operation at the next time. On the other hand, if the target value generating device 2 obtains a positive result in step SP9, the process directly proceeds to step SP11 to end the processing procedure.
【0044】(4)第1の状態における処理 図7の処理手順に示すように、目標値生成装置2が第1
の状態(状態1)における処理RT1に入つたときは、
目標値生成装置2は次のステツプSP21に入つて、ch
flag =1であるか否かを判断し、肯定結果が得られた
とき、すなわち目標値変更が要求されているときには、
ステツプSP22に移つて最終目標値Pm をPm ′に変
更し、その後ステツプSP23に移る。(4) Processing in the first state As shown in the processing procedure of FIG.
When the process RT1 in the state (state 1) is entered,
The target value generation device 2 enters the next step SP21 and ch
When it is determined whether or not flag = 1 and a positive result is obtained, that is, when the target value change is requested,
The transfer connexion final target value P m was changed to P m 'to step SP22, before proceeding to step SP23.
【0045】これに対してステツプSP21において、
目標値生成装置2が否定結果を得ると、そのままステツ
プSP23に移る。続いて目標値生成装置2は、ステツ
プSP23において、最大加速度Amax の値を最大加速
時における1クロツク間に移動する距離とみなし、Pm
−P0 ≦Amax 、すなわち、目標値Pk の移動距離Pm
−P0 がこの最大加速度Amax の値以下であるか否かを
判断する。On the other hand, in step SP21,
When the target value generating device 2 obtains a negative result, the process directly proceeds to step SP23. Subsequently, the target value generating device 2 regards the value of the maximum acceleration A max as the distance moved during one clock at the maximum acceleration in step SP23, and P m
−P 0 ≦ A max , that is, the moving distance P m of the target value P k
It is determined whether -P 0 is less than or equal to the value of this maximum acceleration A max .
【0046】このステツプSP23において肯定結果が
得られたときには、目標値生成装置2はステツプSP2
9に移つて、Vk+1 =Pm −P0 、すなわち、移動距離
Pm−P0 をそのまま定速時における1クロツク間に移
動する速度Vk+1 における距離として、移動対象を状態
3に遷移する。その後、目標値生成装置2はステツプS
P28に移つてch flag =0にする。When a positive result is obtained in step SP23, the target value generating device 2 determines that step SP2.
Moving to 9, V k + 1 = P m −P 0 , that is, the moving distance P m −P 0 is set as the distance at the speed V k + 1 moving in one clock at a constant speed as it is, and the moving object is set to the state. Transition to 3. After that, the target value generator 2 proceeds to step S
Move to P28 and set ch flag = 0.
【0047】これに対してステツプSP23において、
目標値生成装置2が否定結果を得ると、そのままステツ
プSP24に移る。続いて目標値生成装置2は、ステツ
プSP24において、最大加速度Amax の値を最大加速
時における1クロツク間に移動する距離とみなし、Pm
−P0 ≦2×Amax 、すなわち、目標値Pk の移動距離
Pm −P0 がこの最大加速度2×Amax の値以下である
か否かを判断する。On the other hand, in step SP23,
When the target value generator 2 obtains a negative result, the process directly proceeds to step SP24. Subsequently, the target value generation device 2 regards the value of the maximum acceleration A max as the distance moved during one clock at the maximum acceleration in step SP24, and sets P m
−P 0 ≦ 2 × A max , that is, it is determined whether or not the moving distance P m −P 0 of the target value P k is less than or equal to this maximum acceleration 2 × A max .
【0048】このステツプSP24において肯定結果が
得られたときには、目標値生成装置2はステツプSP3
0に移つて、Vk+1 =Amax 、すなわち、次の時刻の速
度Vk+1 を最大加速時における1クロツク間に移動する
速度Amax とし、また減速時の停止位置調整のための値
としてPd =Pm −P0 −Amax とし、移動対象を状態
3に遷移する。その後、目標値生成装置2はステツプS
P28に移つてch flag =0にする。When a positive result is obtained in step SP24, the target value generation device 2 determines that step SP3
Moving to 0, V k + 1 = A max , that is, the speed V k + 1 at the next time is set as the speed A max moving during one clock at the maximum acceleration, and for stopping position adjustment at the time of deceleration. and P d = P m -P 0 -A max as a value, transitioning the mobile object to the state 3. After that, the target value generator 2 proceeds to step S
Move to P28 and set ch flag = 0.
【0049】ここでPd は最大加速度Amax に基づいて
減速したときに、目標値Pk が最終目標値Pm からどれ
だけずれるかを表す値である。この場合、Vk+1 =A
max で移動した後は、状態3で減速するとVk+2 =0で
速度0となつて移動対象が停止してしまうため、Pd =
Pm −P0 −Amax 、すなわち、Pd を目標値Pk の移
動距離Pm −P0 と最大加速時における1クロツク間に
移動する距離Amax との差を最大減速したときの目標値
からのずれになるようにする。Here, P d is a value indicating how much the target value P k deviates from the final target value P m when the vehicle is decelerated based on the maximum acceleration A max . In this case, V k + 1 = A
After moving at max , when decelerating in state 3, the moving target stops at V k + 2 = 0 and velocity 0, so P d =
P m -P 0 -A max, i.e., the target when the maximum deceleration a difference between the distance A max to move the P d between 1 clock in the moving distance P m -P 0 and the maximum acceleration of the target value P k Make sure that it deviates from the value.
【0050】これに対してステツプSP24において否
定結果が得られると、目標値生成装置2はステツプSP
25に移る。上述のステツプSP23及びSP24の処
理は、目標値Pk の移動距離Pm −P0 が非常に小さ
く、最大加速時における1クロツク間の目標値Pk の移
動距離が最終目標値Pm と開始位置P0 との中間位置
(Pm +P0 )/2より大きくなる場合に行われる。On the other hand, when a negative result is obtained in step SP24, the target value generating device 2 determines
Move to 25. Start process of step SP23 and SP24 described above, the moving distance P m -P 0 is very small target value P k, the moving distance of the target values P k between 1 clock at the maximum acceleration and the final target value P m It is performed when it becomes larger than the intermediate position (P m + P 0 ) / 2 with respect to the position P 0 .
【0051】続いて目標値生成装置2は、ステツプSP
25において、最大加速したときの速度Vk+1 =Vk +
Amax がVmax 以上であるか否かの判断をし、肯定結果
が得られたときにはステツプSP31に移つて、Vk+1
=Vmax 、すなわち、次の時刻の速度Vk+1 を最大速度
Vmax とし、またPstop=Pk −P0 、Vstop=Vkと
し、状態2に遷移する。その後、目標値生成装置2はス
テツプSP28に移つてch flag =0にする。Subsequently, the target value generating device 2 determines the step SP.
25, the velocity at maximum acceleration V k + 1 = V k +
It is determined whether A max is V max or more, and if a positive result is obtained, the process proceeds to step SP31, where V k + 1.
= V max , that is, the speed V k + 1 at the next time is set as the maximum speed V max, and P stop = P k −P 0 and V stop = V k are set, and the state 2 is transited to. After that, the target value generation device 2 moves to step SP28 and sets ch flag = 0.
【0052】ここで、Pstopは上述の状態1から状態2
に遷移するときに設定されたデータであり、初速度0の
状態にある移動対象を最大加速度Amax に基づいて加速
したときに、当該移動対象が最大速度Vmax に到達する
までに目標値Pk が移動する距離である。また、Vstop
は移動対象を最大加速度Amax に基づいて加速したとき
に、当該移動対象が最大速度Vmax に到達する直前の速
度である。これに対してステツプSP25において否定
結果が得られると、目標値生成装置2はステツプSP2
6に移る。Here, P stop is the state 1 to the state 2 described above.
When the moving object in the state of the initial speed 0 is accelerated based on the maximum acceleration A max , the target value P is reached until the moving object reaches the maximum speed V max. k is the distance traveled. Also, V stop
Is the speed immediately before the moving object reaches the maximum speed V max when the moving object is accelerated based on the maximum acceleration A max . On the other hand, if a negative result is obtained in step SP25, the target value generation device 2 determines in step SP2.
Go to 6.
【0053】このステツプSP26において目標値生成
装置2は、Pk +Vk +Amax >(Pm +P0 )/2、
すなわち、状態1において加速を続けたと仮定したとき
の次の時刻での目標値Pk+1 (=Pk +Vk +Amax )
が最終目標値Pm と開始位置P0 との中間位置(Pm +
P0 )/2より大きいか否かを判断し、肯定結果が得ら
れたときにはステツプSP32に移つて、速度Vk+1 =
Vk とし、停止位置調整のための値Pd =Pm −P0 −
2×(Pk −P0 )、すなわち、Pd を目標値Pk の移
動距離Pm −P0 から目標値Pk と開始位置P0 との差
の2倍の値を引いたものとして、状態3に遷移する。In this step SP26, the target value generating device 2 determines that P k + V k + A max > (P m + P 0 ) / 2,
That is, the target value P k + 1 (= P k + V k + A max ) at the next time on the assumption that the acceleration is continued in the state 1
Is an intermediate position between the final target value P m and the start position P 0 (P m +
It is determined whether or not it is larger than P 0 ) / 2, and when a positive result is obtained, the process proceeds to step SP32, and the speed V k + 1 =
V k, and a value for adjusting the stop position P d = P m −P 0 −
2 × (P k -P 0), i.e., a minus 2 times the value of the difference between moving a P d of the target value P k distance P m -P 0 target value P k and the start position P 0 from , Transition to state 3.
【0054】ここで、速度Vk をVk −Ak として減速
することなく、Vk と同じ速度にすることにより、移動
対象が停止するまでの移動距離をPk −P0 の値と等し
くすることができ、このため目標値変更の計算を簡便に
し得る。この状態において、目標値生成装置2はステツ
プSP33に移つて、ch flag=1であるか否かを判断
し、肯定結果が得られたときは、目標値生成装置2は目
標位置変更がされた直後であると判断し、ステツプSP
34に移る。Here, the speed V k is set to V k −A k without deceleration, and the speed is set to the same speed as V k , so that the moving distance until the moving object stops becomes equal to the value of P k −P 0. Therefore, the calculation of the target value change can be simplified. In this state, the target value generation device 2 moves to step SP33 to determine whether ch flag = 1, and when a positive result is obtained, the target value generation device 2 has changed the target position. Judge that it is just after, and step SP
Move to 34.
【0055】このステツプSP34において、目標値生
成装置2はPd =0とすることにより、目標位置変更に
よる減速の場合において移動対象をできるだけ早く停止
し得るようになる。その後、目標値生成装置2はステツ
プSP28に移つてch flag=0にする。In this step SP34, the target value generator 2 sets P d = 0 so that the moving object can be stopped as soon as possible in the case of deceleration due to the change of the target position. After that, the target value generation device 2 moves to step SP28 and sets ch flag = 0.
【0056】これに対してステツプSP33において、
目標値生成装置2が否定結果を得ると、そのままステツ
プSP28に移つてch flag =0にする。これに対して
上述のステツプSP26において否定結果が得られる
と、目標値生成装置2はステツプSP27に移つてV
k+1 =Vk +Amax として加速し続け、ステツプSP2
8に移る。On the other hand, in step SP33,
When the target value generation device 2 obtains a negative result, it moves directly to step SP28 and sets ch flag = 0. On the other hand, if a negative result is obtained in step SP26 described above, the target value generation device 2 moves to step SP27 and outputs V
Continue acceleration with k + 1 = V k + A max , and step SP2
Go to 8.
【0057】このステツプSP28において、目標値生
成装置2はch flag =0にした後、ステツプSP9に移
つてstop=1であるか否かを判断し、否定結果が得られ
たときは、目標値生成装置2はステツプSP10に移つ
てk=k+1とした後、再度上述のステツプSP2に戻
つて次の時刻の操作を開始する。これに対してステツプ
SP9において、目標値生成装置2が肯定結果を得る
と、そのままステツプSP11に移つて当該処理手順を
終了する。In this step SP28, the target value generator 2 sets ch flag = 0, then moves to step SP9 and determines whether stop = 1, and when a negative result is obtained, the target value is obtained. The generator 2 moves to step SP10 and sets k = k + 1, then returns to step SP2 again and starts the operation at the next time. On the other hand, if the target value generating device 2 obtains a positive result in step SP9, the process directly proceeds to step SP11 to end the processing procedure.
【0058】(5)第2の状態における処理 図8の処理手順に示すように、目標値生成装置2が第2
の状態(状態2)における処理RT2に入つたときは、
目標値生成装置2は次のステツプSP41に入つて、ch
flag =1であるか否かを判断し、肯定結果が得られた
とき、すなわち目標値変更が要求されているときには、
ステツプSP42に移つて最終目標値Pm をPm ′に変
更し、その後ステツプSP43に移る。これに対してス
テツプSP41において、目標値生成装置2が否定結果
を得ると、そのままステツプSP43に移る。(5) Processing in Second State As shown in the processing procedure of FIG.
When the process RT2 in the state (state 2) is entered,
The target value generation device 2 enters the next step SP41 and ch
When it is determined whether or not flag = 1 and a positive result is obtained, that is, when the target value change is requested,
The transfer connexion final target value P m was changed to P m 'to step SP42, before proceeding to step SP43. On the other hand, if the target value generating device 2 obtains a negative result in step SP41, the process directly proceeds to step SP43.
【0059】このステツプSP43において目標値生成
装置2は、定速で移動したと仮定したときの次の時刻で
の位置Pk+1 =Pk +Vmax が、Pm −Pstop、すなわ
ち、最終目標値Pm と上述のような移動距離Pstopとの
差の値以上であるか否かの判断をし、肯定結果が得られ
たときにはステツプSP45に移つて、Vk+1 =Vstop
として減速を開始し、ここで目標値Pk における移動対
象が速度が0になるまで最大減速されたときの当該移動
対象の停止位置Pstop+Pk と最終目標値Pmとの差の
値をPd (=Pm −(Pstop+Pk )=Pm −Pstop−
Pk )と設定した後状態3に遷移する。In this step SP43, the target value generator 2 determines that the position P k + 1 = P k + V max at the next time when it is assumed that the target value generator 2 has moved at a constant speed is P m -P stop , that is, the final position. It is judged whether or not the difference is greater than the difference between the target value P m and the moving distance P stop as described above, and if a positive result is obtained, the process proceeds to step SP45, where V k + 1 = V stop.
Then, deceleration is started, and here, the value of the difference between the stop position P stop + P k of the moving object and the final target value P m when the moving object at the target value P k is maximally decelerated until the speed becomes 0. P d (= P m − (P stop + P k ) = P m −P stop −
After setting P k ), transit to state 3.
【0060】このように減速時においては、上述の状態
1における加速時の場合と逆のパターンで減速するよう
にする。すなわち、目標値生成装置2が移動対象を減速
するにあたつて、当該目標値生成装置2は最大速度V
max の次の時刻における速度Vk+1 を一旦Vstopにした
後に、最大減速して、目標値Pk+1 の移動距離がPstop
になつたところで移動対象を停止させるようにする。In this way, at the time of deceleration, the pattern is decelerated in the opposite pattern to that at the time of acceleration in the state 1. That is, as the target value generation device 2 decelerates the moving object, the target value generation device 2 is operated at the maximum speed V
After the speed V k + 1 at the next time of max is once set to V stop , the speed is decelerated to the maximum and the moving distance of the target value P k + 1 is P stop.
The target to be moved should be stopped at the time when.
【0061】上記以外に例えば、目標値生成装置2が速
度Vk+1 をVmax −Amax にした後移動対象の減速する
場合は、Vstop>Vmax −Amax で移動対象の減速の度
合いがVstopとした場合に比べて小さいにもかかわら
ず、最大速度Vmax から最大減速し続けても速度Vk+1
が正確に0にならない場合があるため、その場合には目
標値生成装置2における停止位置の計算が煩雑になるお
それがある。さらに、目標値Pk+1 (=Pk +Vmax )
の移動距離が既にPm −Pstopを超えた後に、目標値生
成装置2が移動対象の減速を開始しても、目標値Pk+1
が最終目標値Pmに到達する前に停止できないおそれが
ある。In addition to the above, for example, when the target value generating device 2 decelerates the moving object after setting the speed V k + 1 to V max -A max , V stop > V max -A max . Although the degree is smaller than when V stop is set, even if the maximum deceleration is continued from the maximum speed V max, the speed V k + 1
May not be exactly 0, and in that case, calculation of the stop position in the target value generation device 2 may be complicated. Furthermore, the target value P k + 1 (= P k + V max )
Even if the target value generation device 2 starts decelerating the moving target after the moving distance of P has already exceeded P m −P stop , the target value P k + 1
May not stop before reaching the final target value P m .
【0062】そこで、目標値生成装置2は目標値Pk+1
の移動距離がPm −Pstopを超える直前に移動対象の減
速を開始するようにする。その際、目標値Pk+1 は一般
的には最終目標値Pm に到達する直前で停止するため、
移動対象が減速されている途中において上述した値Pd
=Pm −(Pstop+Pk )を調整することにより、目標
値Pk+1 が最終目標値Pm の位置で正確に停止し得る。Therefore, the target value generator 2 uses the target value P k + 1.
The deceleration of the moving target is started immediately before the moving distance of exceeds P m −P stop . At that time, since the target value P k + 1 generally stops immediately before reaching the final target value P m ,
The above-mentioned value P d while the moving object is being decelerated
= P m - by adjusting the (P stop + P k), the target value P k + 1 can be stopped accurately at the position of the final target value P m.
【0063】上述のような状態において、目標値生成装
置2はステツプSP46に移つて、ch flag =1である
か否かを判断し、肯定結果が得られたときは、目標値生
成装置2は目標位置変更がされた直後であると判断し、
ステツプSP47に移つてPd =0とした後、ステツプ
SP48に移つてch flag =0にする。In the above-mentioned state, the target value generating device 2 moves to step SP46, determines whether ch flag = 1 and if a positive result is obtained, the target value generating device 2 determines Judged that it was just after the target position was changed,
After moving to step SP47 and setting P d = 0, it moves to step SP48 and setting ch flag = 0.
【0064】これに対してステツプSP46において、
目標値生成装置2が否定結果を得ると、そのままステツ
プSP48に移つてch flag =0にする。これに対して
上述のステツプSP43において否定結果が得られる
と、目標値生成装置2はステツプSP44に移つてV
k+1 =Vmax 、すなわち、次の時刻の速度Vk+1 を最大
速度Vmax とし、定速移動を続け、ステツプSP48に
移る。On the other hand, in step SP46,
When the target value generation device 2 obtains a negative result, it proceeds to step SP48 as it is and sets ch flag = 0. On the other hand, if a negative result is obtained in step SP43 described above, the target value generation device 2 moves to step SP44 and V
k + 1 = V max , that is, the speed V k + 1 at the next time is set as the maximum speed V max , the constant speed movement is continued, and the process proceeds to step SP48.
【0065】このステツプSP48において、目標値生
成装置2はch flag =0にした後、ステツプSP9に移
つてstop=1であるか否かを判断し、否定結果が得られ
たときは、目標値生成装置2はステツプSP10に移つ
てk=k+1とした後、再度上述のステツプSP2に戻
つて次の時刻の操作を開始する。これに対してステツプ
SP9において、目標値生成装置2が肯定結果を得る
と、そのままステツプSP11に移つて当該処理手順を
終了する。In step SP48, the target value generator 2 sets ch flag = 0 and then moves to step SP9 to determine whether stop = 1. If a negative result is obtained, the target value is set. The generator 2 moves to step SP10 and sets k = k + 1, then returns to step SP2 again and starts the operation at the next time. On the other hand, if the target value generating device 2 obtains a positive result in step SP9, the process directly proceeds to step SP11 to end the processing procedure.
【0066】(6)第3の状態における処理 図9の処理手順に示すように、目標値生成装置2が第3
の状態(状態3)における処理RT3に入つたときは、
目標値生成装置2は次のステツプSP50に入つて、ch
flag =1であるか否かを判断し、肯定結果が得られた
とき、すなわち目標値変更が要求されているときには、
ステツプSP57に移つて最終目標値Pm をPm ′に変
更する。(6) Processing in Third State As shown in the processing procedure of FIG.
When entering the processing RT3 in the state (state 3) of
The target value generation device 2 enters the next step SP50 and ch
When it is determined whether or not flag = 1 and a positive result is obtained, that is, when the target value change is requested,
The transfer connexion final target value P m is changed to P m 'to step SP57.
【0067】このステツプSP57において、Pm ′<
Pm −Pd 、すなわち、変更後の最終目標値Pm ′が変
更前の最終目標値Pm と減速時において停止位置を最終
目標値Pm に一致させるために設定された調整用の値P
d との差の値よりも小さい場合は、目標値生成装置2は
ステツプSP58に移つてPd =0とし、状態3のまま
目標値生成装置2はステツプSP51に移る。At this step SP57, P m ′ <
P m -P d, i.e., the value for adjustment is the final target value P m 'after the change is set to match the stop position to the final target value P m during deceleration the final target value P m before change P
If it is smaller than the value of the difference from d , the target value generating device 2 moves to step SP58 to set P d = 0, and the target value generating device 2 moves to step SP51 while keeping the state 3.
【0068】またステツプSP57において、Pm −P
d ≦P′m ≦Pm +2×Vk 、すなわち、変更後の最終
目標値Pm ′が変更前の最終目標値Pm と上記停止位置
調整のための値Pd との差の値以上であり、かつ変更前
の最終目標値Pm と定速時における2クロツク間に移動
する距離2×Vk の値との和の値以下である場合は、目
標値生成装置2はステツプSP59に移つて、Pd をP
d +(Pm ′−Pm )に変更し、状態3のまま目標値生
成装置2はステツプSP51に移る。In step SP57, P m -P
d ≦ P ′ m ≦ P m + 2 × V k , that is, the changed final target value P m ′ is greater than or equal to the difference between the pre-change final target value P m and the stop position adjustment value P d. And is less than or equal to the sum of the final target value P m before change and the value of the distance 2 × V k moving between two clocks at constant speed, the target value generation device 2 proceeds to step SP59. Transfer, P d to P
The value is changed to d + (P m ′ −P m ), and the target value generation device 2 remains in the state 3 and proceeds to step SP51.
【0069】ここで、このように目標値変更の度合いが
小さい場合においては、目標値生成装置2は上記停止位
置調整のための値Pd を調整することにより、移動対象
の減速を調整でき、従つて目標値変更に対応し得る。Here, when the degree of change of the target value is small, the target value generating device 2 can adjust the deceleration of the moving object by adjusting the value P d for the stop position adjustment, Therefore, the target value can be changed.
【0070】またステツプSP57において、P′m >
Pm +2×Vk 、すなわち、変更後の最終目標値Pm ′
が変更前の最終目標値Pm と定速時における2クロツク
間に移動する距離2×Vk の値との和の値よりも大きい
場合は、目標値生成装置2はステツプSP60に移つ
て、開始位置P0 をP0 =2×Pk −Pm +Pd 、すな
わち、目標値Pk の2倍の値と最終目標値Pm との差に
調整用の値Pd を加えたものに変更し、再度Vk+1 =V
k +Amax に基づく加速をし得るように状態1に遷移し
た後、目標値生成装置2はステツプSP51に移る。[0070] In step SP57, P 'm>
P m + 2 × V k , that is, the changed final target value P m ′
Is larger than the sum of the final target value P m before the change and the value of the distance 2 × V k moving between two clocks at the time of constant speed, the target value generator 2 moves to step SP60. The start position P 0 is set to P 0 = 2 × P k −P m + P d , that is, the difference between the value twice the target value P k and the final target value P m plus the adjustment value P d. Change and again V k + 1 = V
After transitioning to the state 1 so that the acceleration based on k + A max can be performed, the target value generator 2 proceeds to step SP51.
【0071】これに対してステツプSP50において、
目標値生成装置2が否定結果を得ると、そのままステツ
プSP51に移る。続いてステツプSP51において、
目標値生成装置2はPk =Pm かつVk ≦Amax 、すな
わち、目標値Pk が最終目標値Pm と同じ値であり、か
つ速度Vkが最大加速時における1クロツク間に移動す
る速度Amax の値以下であるか否かを判断し、肯定結果
が得られたときにはステツプSP61に移る。On the other hand, in step SP50,
When the target value generating device 2 obtains a negative result, the process directly proceeds to step SP51. Then, in step SP51,
The target value generator 2 has P k = P m and V k ≦ A max , that is, the target value P k is the same value as the final target value P m , and the speed V k moves during one clock at maximum acceleration. It is determined whether or not the speed is equal to or less than the value of the speed A max. When a positive result is obtained, the process proceeds to step SP61.
【0072】このステツプSP61において、目標値生
成装置2は移動対象を最大減速することによつて次の時
刻の速度Vk+1 をVk+1 =0とした後、stop=1、すな
わち、目標値Pk が最終目標値Pm に到達したものとみ
なして移動対象を停止する。続いて目標値生成装置2は
ステツプSP56に移つてch flag =0にする。In this step SP61, the target value generator 2 decelerates the moving object to the maximum, thereby setting the velocity V k + 1 at the next time to V k + 1 = 0, and then stop = 1, that is, The moving object is stopped on the assumption that the target value P k has reached the final target value P m . Then, the target value generation device 2 moves to step SP56 and sets ch flag = 0.
【0073】これに対してステツプSP51において否
定結果が得られると、目標値生成装置2はステツプSP
52に移る。続いて目標値生成装置2は、目標値変更に
より目標値Pk が最終目標値Pm の値を超えてしまつた
場合の処理をすることにする。On the other hand, if a negative result is obtained in step SP51, the target value generating device 2 determines
Move to 52. Subsequently, the target value generation device 2 will perform processing when the target value P k exceeds the final target value P m due to the target value change.
【0074】このステツプSP52において、目標値生
成装置2はPk >Pm かつVk −Amax +Pd <0、す
なわち、目標値Pk が最終目標値Pm より大きく、かつ
最大加速度Amax に基づいて減速したときの速度Vk が
負の値になるか否かを判断し、肯定結果が得られたとき
にはステツプSP62に移つて、次の時刻の速度Vk+1
を0とし、また開始位置P0 を目標値Pk に置き換え
て、上述の場合と逆方向の移動を開始し得るように状態
4に遷移した後、目標値生成装置2はステツプSP56
に移つてch flag =0にする。In this step SP52, the target value generating device 2 determines that P k > P m and V k −A max + P d <0, that is, the target value P k is larger than the final target value P m and the maximum acceleration A max. It is determined whether the speed V k at the time of deceleration has a negative value or not, and if a positive result is obtained, the process proceeds to step SP62 and the speed V k + 1 at the next time is determined.
Is set to 0, and the start position P 0 is replaced with the target value P k , and after transitioning to state 4 so that movement in the direction opposite to the above case can be started, the target value generation device 2 proceeds to step SP56.
, And set ch flag = 0.
【0075】これに対してステツプSP52において否
定結果が得られると、目標値生成装置2はステツプSP
53に移る。続いて目標値生成装置2は、移動対象を最
大減速して目標値Pk が最終目標値Pm で正確に停止し
得るように調整する。On the other hand, if a negative result is obtained at step SP52, the target value generating device 2 determines at step SP52.
Move to 53. Subsequently, the target value generation device 2 adjusts the moving object to the maximum deceleration so that the target value P k can accurately stop at the final target value P m .
【0076】このステツプSP53において、目標値生
成装置2はVk ≦Pd 、すなわち、前の時刻の速度Vk
が上記停止位置調整のための値Pd 以下であるか否かを
判断し、肯定結果が得られたときにはステツプSP63
に移つて、前の時刻の速度Vk が次の時刻においても同
じ速度となるように次の時刻の速度Vk+1 をVk とす
る。In this step SP53, the target value generator 2 determines V k ≤P d , that is, the velocity V k at the previous time.
Is below the value P d for the stop position adjustment, and if a positive result is obtained, step SP63
Moves connexion, velocity V k of the previous time is also a V k the velocity V k + 1 of the next time so that the same speed at the next time to.
【0077】その後、目標値生成装置2は再度最大減速
することにより、停止位置が定速度における1クロツク
間に移動する距離Vk だけ先に位置することになり、従
つて、最大減速を続けてしたときの停止位置と最終目標
値Pm との差Pd は小さくなる。これに従つて、このP
d をPd −Vk に置き換えることにより、Pd は次第に
小さくなる。その後、目標値生成装置2はステツプSP
56に移つてch flag=0にする。これに対してステツ
プSP53において否定結果が得られると、目標値生成
装置2はステツプSP54に移る。After that, the target value generator 2 again performs maximum deceleration, so that the stop position is positioned ahead by the distance V k that moves during one clock at a constant speed, and accordingly, maximum deceleration is continued. The difference P d between the stop position and the final target value P m at that time becomes small. According to this, this P
By replacing d with P d −V k , P d becomes smaller and smaller. After that, the target value generation device 2 proceeds to step SP.
Move to 56 and set ch flag = 0. On the other hand, if a negative result is obtained in step SP53, the target value generation device 2 moves to step SP54.
【0078】このステツプSP54において、目標値生
成装置2はVk+1 +Pd =Vk −Amax +Pd ≦
Amax 、すなわち、定速度における1クロツク間に移動
する距離Vk+1 と調整用の値Pd との和の値が最大加速
時における1クロツク間に移動する速度Amax 以下であ
るか否かを判断し、肯定結果が得られたときはステツプ
SP64に移つて、次の時刻における速度Vk+1 をV
k+1 +Pd =Vk −Amax +Pd と置き換えることによ
り、目標値Pk+1 を最終目標値Pm と一致させることが
できる。その後、目標値生成装置2はステツプSP56
に移つてch flag =0にする。In this step SP54, the target value generator 2 has V k + 1 + P d = V k -A max + P d ≤
A max, i.e., the distance V k + 1 and whether the value of the sum of the value P d for adjustment is equal to or less than the speed A max to move between a clock at the maximum acceleration that moves between a clock in the constant speed If a positive result is obtained, the process proceeds to step SP64 to set the velocity V k + 1 at the next time to V
The target value P k + 1 can be matched with the final target value P m by replacing k + 1 + P d = V k −A max + P d . After that, the target value generation device 2 proceeds to step SP56.
, And set ch flag = 0.
【0079】これに対してステツプSP54において否
定結果が得られると、目標値生成装置2はステツプSP
55に移る。このステツプSP55において、目標値生
成装置2はVk+1 =Vk −Amax として減速した後ステ
ツプSP56に移る。On the other hand, if a negative result is obtained at step SP54, the target value generating device 2 determines at step SP.
Move to 55. In this step SP55, the target value generator 2 decelerates to V k + 1 = V k -A max , and then proceeds to step SP56.
【0080】このステツプSP56において、目標値生
成装置2はch flag =0にした後、ステツプSP9に移
つてstop=1であるか否かを判断し、否定結果が得られ
たときは、目標値生成装置2はステツプSP10に移つ
てk=k+1とした後、再度上述のステツプSP2に戻
つて次の時刻の操作を開始する。これに対してステツプ
SP9において、目標値生成装置2が肯定結果を得る
と、そのままステツプSP11に移つて当該処理手順を
終了する。In step SP56, the target value generator 2 sets ch flag = 0 and then moves to step SP9 to determine whether stop = 1. If a negative result is obtained, the target value is set. The generator 2 moves to step SP10 and sets k = k + 1, then returns to step SP2 again and starts the operation at the next time. On the other hand, if the target value generating device 2 obtains a positive result in step SP9, the process directly proceeds to step SP11 to end the processing procedure.
【0081】(7)第4の状態における処理 図10の処理手順に示すように、目標値生成装置2が第
4の状態(状態4)における処理RT4に入つたとき
は、目標値生成装置2は次のステツプSP70に入つ
て、ch flag =1であるか否かを判断し、肯定結果が得
られたとき、すなわち目標値変更が要求されているとき
には、ステツプSP71に移つて最終目標値Pm を
Pm ′に変更し、その後ステツプSP72に移る。(7) Processing in Fourth State As shown in the processing procedure of FIG. 10, when the target value generation device 2 enters the processing RT4 in the fourth state (state 4), the target value generation device 2 Goes to the next step SP70, determines whether ch flag = 1 and when a positive result is obtained, that is, when the target value change is requested, the process proceeds to step SP71 and the final target value P Change m to P m ', and then move to step SP72.
【0082】これに対してステツプSP70において、
目標値生成装置2が否定結果を得ると、そのままステツ
プSP72に移る。続いて目標値生成装置2は、ステツ
プSP72において、最大加速度Amax の値を最大加速
時における1クロツク間に移動する距離とみなし、Pm
−P0 ≧−Amax 、すなわち、目標値Pk の移動距離P
m −P0 がこの最大加速度Amax の負の値以上であるか
否かを判断する。On the other hand, in step SP70,
When the target value generating device 2 obtains a negative result, the process directly proceeds to step SP72. Subsequently, the target value generation device 2 regards the value of the maximum acceleration A max as the distance moved during one clock at the maximum acceleration in step SP72, and sets P m
−P 0 ≧ −A max , that is, the moving distance P of the target value P k
It is determined whether or not m −P 0 is greater than or equal to the negative value of this maximum acceleration A max .
【0083】このステツプSP72において肯定結果が
得られたときには、目標値生成装置2はステツプSP7
8に移つて、Vk+1 =Pm −P0 、すなわち、移動距離
Pm−P0 をそのまま1クロツク間に移動する速度V
k+1 における距離として、移動対象を状態6に遷移す
る。その後、目標値生成装置2はステツプSP77に移
つてch flag =0にする。When a positive result is obtained in step SP72, the target value generating device 2 determines in step SP7.
8, V k + 1 = P m −P 0 , that is, the speed V at which the moving distance P m −P 0 moves as it is for one clock.
As the distance at k + 1 , the movement target transits to state 6. After that, the target value generation device 2 moves to step SP77 and sets ch flag = 0.
【0084】これに対してステツプSP72において、
目標値生成装置2が否定結果を得ると、そのままステツ
プSP73に移る。続いて目標値生成装置2は、ステツ
プSP73において、最大加速度Amax の値を最大加速
時における1クロツク間に移動する距離とみなし、Pm
−P0 ≧−2×Amax 、すなわち、目標値Pk の移動距
離Pm −P0 がこの最大加速度2×Amax の負の値以上
であるか否かを判断する。On the other hand, in step SP72,
When the target value generator 2 obtains a negative result, the process directly proceeds to step SP73. Then, in step SP73, the target value generation device 2 regards the value of the maximum acceleration A max as the distance moved during one clock at the maximum acceleration, and P m
−P 0 ≧ −2 × A max , that is, it is determined whether the moving distance P m −P 0 of the target value P k is greater than or equal to the negative value of this maximum acceleration 2 × A max .
【0085】このステツプSP73において肯定結果が
得られたときには、目標値生成装置2はステツプSP7
9に移つて、速度Vk+1 =−Amax 、すなわち、次の時
刻の速度Vk+1 を最大加速時における1クロツク間に移
動する速度Amax の負の値とし、また減速時の停止位置
調整のための値としてPd =Pm −P0 +Amax とし、
移動対象を状態6に遷移する。その後、目標値生成装置
2はステツプSP77に移つてch flag =0にする。When a positive result is obtained in step SP73, the target value generating device 2 determines in step SP7.
Moving to 9, the speed V k + 1 = −A max , that is, the speed V k + 1 at the next time is set to a negative value of the speed A max moving during one clock at the maximum acceleration, and at the time of deceleration. As a value for adjusting the stop position, P d = P m −P 0 + A max ,
The movement target transits to state 6. After that, the target value generation device 2 moves to step SP77 and sets ch flag = 0.
【0086】ここでPd は最大加速度Amax に基づいて
減速したときに、目標値Pk が最終目標値Pm からどれ
だけずれるかを表している。この場合、Vk+1 =−A
max で移動した後は、状態6で減速するとVk+2 =0で
速度0となつて移動対象が停止してしまうため、Pd =
Pm −P0 +Amax 、すなわち、Pd を目標値Pk の移
動距離Pm −P0 と最大加速時における1クロツク間に
移動する距離Amax の負の値との差を最大減速したとき
の目標値からのずれになるようにする。Here, P d represents how much the target value P k deviates from the final target value P m when the vehicle is decelerated based on the maximum acceleration A max . In this case, V k + 1 = −A
After moving at max , when decelerating in state 6, the moving target stops at V k + 2 = 0 and velocity 0, so P d =
P m -P 0 + A max, i.e., the maximum deceleration a difference between the negative value of the distance A max to move the P d between 1 clock in the moving distance P m -P 0 and the maximum acceleration of the target value P k The deviation from the target value at
【0087】これに対してステツプSP73において否
定結果が得られると、目標値生成装置2はステツプSP
74に移る。上述のステツプSP72及びSP73の処
理は、目標値Pk の移動距離Pm −P0 が非常に小さ
く、最大加速時における1クロツク間の目標値Pk の移
動距離が最終目標値Pm と開始位置P0 との中間位置
(Pm +P0 )/2より大きくなる場合に行われる。On the other hand, if a negative result is obtained in step SP73, the target value generating device 2 determines
Move to 74. Start process of step SP72 and SP73 described above, the moving distance P m -P 0 is very small target value P k, the moving distance of the target values P k between 1 clock at the maximum acceleration and the final target value P m It is performed when it becomes larger than the intermediate position (P m + P 0 ) / 2 with respect to the position P 0 .
【0088】続いて目標値生成装置2は、ステツプSP
74において、最大加速したときの速度Vk+1 =Vk −
Amax が−Vmax 以下であるか否かの判断をし、肯定結
果が得られたときにはステツプSP80に移つて、V
k+1 =−Vmax 、すなわち、次の時刻の速度Vk+1 を最
大速度Vmax の負の値とし、またPstop=Pk −P0 、
Vstop=Vk とし、状態5に遷移する。その後、目標値
生成装置2はステツプSP77に移つてch flag =0に
する。Subsequently, the target value generating device 2 determines that the step SP
At 74, the maximum acceleration speed V k + 1 = V k −
It is determined whether A max is less than or equal to −V max , and if a positive result is obtained, the process proceeds to step SP80, where V
k + 1 = −V max , that is, the velocity V k + 1 at the next time is set as a negative value of the maximum velocity V max , and P stop = P k −P 0 ,
Set V stop = V k, and transit to state 5. After that, the target value generation device 2 moves to step SP77 and sets ch flag = 0.
【0089】ここで、Pstopは上述の状態4から状態5
に遷移するときに設定されたデータであり、初速度0の
状態にある移動対象を最大加速度Amax に基づいて加速
したときに、当該移動対象が最大速度Vmax に到達する
までに目標値Pk が移動する距離である。また、Vstop
は移動対象を最大加速度Amax に基づいて加速したとき
に、当該移動対象が最大速度Vmax に到達する直前の速
度である。これに対してステツプSP74において否定
結果が得られると、目標値生成装置2はステツプSP7
5に移る。Here, P stop is the above-mentioned state 4 to state 5
When the moving object in the state of the initial speed 0 is accelerated based on the maximum acceleration A max , the target value P is reached until the moving object reaches the maximum speed V max. k is the distance traveled. Also, V stop
Is the speed immediately before the moving object reaches the maximum speed V max when the moving object is accelerated based on the maximum acceleration A max . On the other hand, if a negative result is obtained in step SP74, the target value generation device 2 proceeds to step SP7.
Go to 5.
【0090】このステツプSP75において目標値生成
装置2は、Pk +Vk −Amax <(Pm +P0 )/2、
すなわち、状態4において加速を続けたと仮定したとき
の次の時刻での位置Pk+1 (=Pk +Vk −Amax )が
最終目標値Pm と開始位置P0 との中間位置(Pm +P
0 )/2より小さいか否かを判断し、肯定結果が得られ
たときにはステツプSP81に移つて、速度Vk+1 =V
k とし、停止位置調整のための値Pd =Pm −P0 −2
×(Pk −P0 )、すなわち、Pd を目標値Pk の移動
距離Pm −P0 から目標値Pk と開始位置P0 との差の
2倍の値を引いたものとして、状態6に遷移する。At this step SP75, the target value generating device 2 determines that P k + V k -A max <(P m + P 0 ) / 2,
That is, the position P k + 1 (= P k + V k −A max ) at the next time when it is assumed that the acceleration is continued in the state 4 is the intermediate position (P P) between the final target value P m and the start position P 0. m + P
0 ) / 2 or less, and when a positive result is obtained, the process proceeds to step SP81, and the speed V k + 1 = V
k, and the value for adjusting the stop position P d = P m −P 0 −2
× (P k -P 0), i.e., a minus 2 times the value of the difference between moving a P d of the target value P k distance P m -P 0 target value P k and the start position P 0 from Transition to state 6.
【0091】ここで、速度Vk をVk −Ak として減速
することなく、Vk と同じ速度にすることにより、移動
対象が停止するまでの移動距離をPk −P0 の値と等し
くすることができ、このため目標値変更の計算を簡便に
し得る。この状態において、目標値生成装置2はステツ
プSP82に移つて、ch flag=1であるか否かを判断
し、肯定結果が得られたときは、目標値生成装置2は目
標位置変更がされた直後であると判断し、ステツプSP
83に移る。Here, the speed V k is set to V k −A k without deceleration, and the speed is set to the same speed as V k , so that the moving distance until the moving object stops becomes equal to the value of P k −P 0. Therefore, the calculation of the target value change can be simplified. In this state, the target value generation device 2 moves to step SP82 to determine whether ch flag = 1, and when a positive result is obtained, the target value generation device 2 has changed the target position. Judge that it is just after, and step SP
Move to 83.
【0092】このステツプSP83において、目標値生
成装置2はPd =0とすることにより、目標値変更によ
る減速の場合において移動対象をできるだけ早く停止し
得るようになる。その後、目標値生成装置2はステツプ
SP77に移つてch flag =0にする。これに対してス
テツプSP82において、目標値生成装置2が否定結果
を得ると、そのままステツプSP77に移つてch flag
=0にする。In this step SP83, the target value generator 2 sets P d = 0 so that the moving object can be stopped as soon as possible in the case of deceleration by changing the target value. After that, the target value generation device 2 moves to step SP77 and sets ch flag = 0. On the other hand, if the target value generating device 2 obtains a negative result in step SP82, the process directly proceeds to step SP77 and ch flag is set.
= 0.
【0093】これに対して上述のステツプSP75にお
いて否定結果が得られると、目標値生成装置2はステツ
プSP76に移つてVk+1 =Vk −Amax として加速し
続けステツプSP77に移る。On the other hand, when a negative result is obtained in step SP75, the target value generation device 2 moves to step SP76 and continues acceleration with V k + 1 = V k -A max , and moves to step SP77.
【0094】このステツプSP77において、目標値生
成装置2はch flag =0にした後、ステツプSP9に移
つてstop=1であるか否かを判断し、否定結果が得られ
たときは、目標値生成装置2はステツプSP10に移つ
てk=k+1とした後、再度上述のステツプSP2に戻
つて次の時刻の操作を開始する。これに対してステツプ
SP9において、目標値生成装置2が肯定結果を得る
と、そのままステツプSP11に移つて当該処理手順を
終了する。In this step SP77, the target value generating device 2 sets ch flag = 0, then moves to step SP9 and determines whether stop = 1, and when a negative result is obtained, the target value is obtained. The generator 2 moves to step SP10 and sets k = k + 1, then returns to step SP2 again and starts the operation at the next time. On the other hand, if the target value generating device 2 obtains a positive result in step SP9, the process directly proceeds to step SP11 to end the processing procedure.
【0095】(8)第5の状態における処理 図11の処理手順に示すように、目標値生成装置2が第
5の状態(状態5)における処理RT5に入つたとき
は、目標値生成装置2は次のステツプSP80に入つ
て、ch flag =1であるか否かを判断し、肯定結果が得
られたとき、すなわち目標値変更が要求されているとき
には、ステツプSP81に移つて最終目標値Pm を
Pm ′に変更し、その後ステツプSP82に移る。これ
に対してステツプSP80において、目標値生成装置2
が否定結果を得ると、そのままステツプSP82に移
る。(8) Processing in Fifth State As shown in the processing procedure of FIG. 11, when the target value generation device 2 enters the processing RT5 in the fifth state (state 5), the target value generation device 2 Goes to the next step SP80 to determine whether ch flag = 1 and when a positive result is obtained, that is, when the target value change is requested, the process proceeds to step SP81 and the final target value P Change m to P m ′, and then move to step SP82. On the other hand, in step SP80, the target value generator 2
Obtains a negative result, it proceeds directly to step SP82.
【0096】このステツプSP82において目標値生成
装置2は、定速で移動したと仮定したときの次の時刻で
の位置Pk+1 =Pk −Vmax が、Pm +Pstop、すなわ
ち、最終目標値Pm と上述のような移動距離Pstopとの
和の値以下であるか否かの判断をし、肯定結果が得られ
たときにはステツプSP85に移つて、Vk+1 =Vstop
として減速を開始し、ここで目標値Pk における移動対
象が速度が0になるまで最大減速されたときの当該移動
対象の停止位置Pstop−Pk と最終目標値Pmとの和の
値をPd (=Pm +Pstop−Pk )と設定した後状態6
に遷移する。In this step SP82, the target value generator 2 determines that the position P k + 1 = P k -V max at the next time when it is assumed that the target value generator 2 has moved at a constant speed is P m + P stop , that is, the final position. It is determined whether or not the value is equal to or less than the sum of the target value P m and the above-mentioned moving distance P stop, and if a positive result is obtained, the process proceeds to step SP85, where V k + 1 = V stop.
As starts deceleration, wherein the value of the sum of the stopping position of the moving object P stop -P k and the final target value P m when the mobile object in the target value P k is maximum deceleration until the speed becomes 0 Is set as P d (= P m + P stop −P k ), the state 6
Transition to.
【0097】このように減速時においては、上述の状態
4における加速時の場合と逆のパターンで減速するよう
にする。すなわち、目標値生成装置2が移動対象を減速
するにあたつて、当該目標値生成装置2は最大速度V
max の次の時刻における速度Vk+1 を一旦Vstopにした
後に、目標値Pk+1 の移動距離がPm −Pstopを超える
直前に移動対象の最大減速を開始し、目標値Pk+1 の移
動距離がPstopになつたところで移動対象を停止させる
ようにする。As described above, at the time of deceleration, the pattern is decelerated in a pattern opposite to that at the time of acceleration in the above-mentioned state 4. That is, as the target value generation device 2 decelerates the moving object, the target value generation device 2 is operated at the maximum speed V
After the speed V k + 1 at the time next to max is once set to V stop , the maximum deceleration of the moving object is started immediately before the moving distance of the target value P k + 1 exceeds P m −P stop , and the target value P is set. The moving object is stopped when the moving distance of k + 1 reaches P stop .
【0098】その際、目標値Pk+1 は一般的には最終目
標値Pm に到達する直前で停止するため、移動対象が減
速されている途中において上述した値Pd =Pm +P
stop−Pk を調整することにより、目標値Pk+1 が最終
目標値Pm の位置で正確に停止し得る。At this time, since the target value P k + 1 generally stops just before reaching the final target value P m , the above-mentioned value P d = P m + P while the moving object is being decelerated.
By adjusting stop −P k , the target value P k + 1 can be stopped exactly at the position of the final target value P m .
【0099】この状態において、目標値生成装置2はス
テツプSP86に移つて、ch flag=1であるか否かを
判断し、肯定結果が得られたときは、目標値生成装置2
は目標位置変更がされた直後であると判断し、ステツプ
SP87に移つてPd =0とした後ステツプSP84に
移つてch flag =0にする。In this state, the target value generating device 2 moves to step SP86 to determine whether ch flag = 1, and when a positive result is obtained, the target value generating device 2
Judges that it is immediately after the target position is changed, moves to step SP87 to set P d = 0 and then moves to step SP84 to set ch flag = 0.
【0100】これに対してステツプSP86において、
目標値生成装置2が否定結果を得ると、そのままステツ
プSP84に移つてch flag =0にする。これに対して
上述のステツプSP82において否定結果が得られる
と、目標値生成装置2はステツプSP83に移つてV
k+1 =Vmax 、すなわち、次の時刻の速度Vk+1 を最大
速度Vmax とし、定速移動を続け、ステツプSP84に
移る。On the other hand, in step SP86,
When the target value generating device 2 obtains a negative result, it proceeds to step SP84 as it is and sets ch flag = 0. On the other hand, if a negative result is obtained in step SP82, the target value generation device 2 moves to step SP83
k + 1 = V max , that is, the speed V k + 1 at the next time is set as the maximum speed V max , the constant speed movement is continued, and the process proceeds to step SP84.
【0101】このステツプSP84において、目標値生
成装置2はch flag =0にした後、ステツプSP9に移
つてstop=1であるか否かを判断し、否定結果が得られ
たときは、目標値生成装置2はステツプSP10に移つ
てk=k+1とした後、再度上述のステツプSP2に戻
つて次の時刻の操作を開始する。これに対してステツプ
SP9において、目標値生成装置2が肯定結果を得る
と、そのままステツプSP11に移つて当該処理手順を
終了する。In step SP84, the target value generator 2 sets ch flag = 0 and then moves to step SP9 to determine whether or not stop = 1. If a negative result is obtained, the target value is set. The generator 2 moves to step SP10 and sets k = k + 1, then returns to step SP2 again and starts the operation at the next time. On the other hand, if the target value generating device 2 obtains a positive result in step SP9, the process directly proceeds to step SP11 to end the processing procedure.
【0102】(9)第6の状態における処理 図12の処理手順に示すように、目標値生成装置2が第
6の状態(状態6)における操作処理RT6に入つたと
きは、目標値生成装置2は次のステツプSP90に入つ
て、ch flag =1であるか否かを判断し、肯定結果が得
られたとき、すなわち目標値変更が要求されているとき
には、ステツプSP97に移つて最終目標値Pm を
Pm ′に変更する。(9) Processing in the sixth state As shown in the processing procedure of FIG. 12, when the target value generation device 2 enters the operation processing RT6 in the sixth state (state 6), the target value generation device 2 goes to the next step SP90 to judge whether ch flag = 1 or not, and when a positive result is obtained, that is, when the target value change is requested, the process goes to step SP97 to set the final target value. Change P m to P m ′.
【0103】このステツプSP97において、Pm ′>
Pm −Pd 、すなわち、変更後の最終目標値Pm ′が変
更前の最終目標値Pm と減速時において停止位置を最終
目標値Pm に一致させるために設定された調整用の値P
d との差の値より大きい場合は、目標値生成装置2はス
テツプSP98に移つてPd =0とし、状態6のまま目
標値生成装置2はステツプSP91に移る。At this step SP97, P m ′>
P m -P d, i.e., the value for adjustment is the final target value P m 'after the change is set to match the stop position to the final target value P m during deceleration the final target value P m before change P
If it is larger than the difference from d , the target value generator 2 moves to step SP98 to set P d = 0, and the target value generator 2 remains in state 6 and moves to step SP91.
【0104】またステツプSP97において、Pm −P
d ≧P′m ≧Pm +2×Vk 、すなわち、変更後の最終
目標値Pm ′が変更前の最終目標値Pm と上記停止位置
調整のための値Pd との差の値以下の場合は、目標値生
成装置2はステツプSP99に移つて、Pd をPd +
(Pm ′−Pm )に変更し、状態6のまま目標値生成装
置2はステツプSP91に移る。Further, in step SP97, P m -P
d ≧ P ′ m ≧ P m + 2 × V k , that is, the changed final target value P m ′ is less than or equal to the difference between the pre-change final target value P m and the stop position adjustment value P d. In the case of, the target value generation device 2 moves to step SP99 and sets P d to P d +
(P m ′ −P m ), and the target value generation device 2 moves to step SP91 while maintaining the state 6.
【0105】ここで、このように目標値変更の度合いが
小さい場合においては、目標値生成装置2は上記停止位
置調整のための値Pd を調整することにより、移動対象
の減速を調整でき、従つて目標値変更に対応し得る。Here, when the degree of change of the target value is small as described above, the target value generating device 2 can adjust the deceleration of the moving object by adjusting the value P d for the stop position adjustment, Therefore, the target value can be changed.
【0106】またステツプSP97において、P′m <
Pm +2×Vk 、すなわち、変更後の最終目標値Pm ′
が変更前の最終目標値Pm と定速時における2クロツク
間に移動する距離2×Vk の値との和の値より小さい場
合は、目標値生成装置2はステツプSP100に移つ
て、開始位置P0 をP0 =2×Pk −Pm +Pd に変更
し、再度Vk+1 =Vk −Amax に基づく加速をし得るよ
うに状態4に遷移した後、目標値生成装置2はステツプ
SP91に移る。[0106] In step SP97, P 'm <
P m + 2 × V k , that is, the changed final target value P m ′
Is smaller than the sum of the final target value P m before the change and the value of the distance 2 × V k that moves between two clocks at constant speed, the target value generation device 2 moves to step SP100 and starts. After changing the position P 0 to P 0 = 2 × P k −P m + P d and again transiting to the state 4 so that acceleration based on V k + 1 = V k −A max can be performed, the target value generation device 2 moves to step SP91.
【0107】やがてステツプSP90において、目標値
生成装置2が否定結果を得ると、そのままステツプSP
91に移る。続いてステツプSP91において、目標値
生成装置2はPk =Pm かつVk ≧−Amax 、すなわ
ち、目標値Pk が最終目標値Pm と同じ値であり、かつ
速度Vk が最大加速時における1クロツク間に移動する
速度Amax の負の値以上であるか否かを判断し、肯定結
果が得られたときにはステツプSP101に移る。When the target value generating device 2 obtains a negative result in step SP90, the process proceeds to step SP90.
Move to 91. Subsequently, in step SP91, the target value generation device 2 determines that P k = P m and V k ≧ −A max , that is, the target value P k is the same value as the final target value P m , and the speed V k is the maximum acceleration. It is determined whether or not the moving speed A max during one clock is equal to or more than a negative value, and if a positive result is obtained, the process proceeds to step SP101.
【0108】このステツプSP101において、目標値
生成装置2は移動対象を最大減速することによつて次の
時刻の速度Vk+1 をVk+1 =0として、stop=1、すな
わち目標値Pk が最終目標値Pm に到達したものとみな
して移動対象を停止する。続いて目標値生成装置2はス
テツプSP96に移つてch flag =0にする。In this step SP101, the target value generator 2 decelerates the moving object to the maximum so that the speed V k + 1 at the next time is set to V k + 1 = 0 and stop = 1, that is, the target value P. Assuming that k has reached the final target value P m , the moving target is stopped. Then, the target value generation device 2 moves to step SP96 and sets ch flag = 0.
【0109】やがてステツプSP91において否定結果
が得られると、目標値生成装置2はステツプSP92に
移る。続いて目標値生成装置2は、目標値変更により目
標値Pk が最終目標値Pm の値を超えてしまつた場合の
処理をすることにする。When a negative result is obtained in step SP91, the target value generator 2 proceeds to step SP92. Subsequently, the target value generation device 2 will perform processing when the target value P k exceeds the final target value P m due to the target value change.
【0110】このステツプSP92において、目標値生
成装置2はPk <Pm かつVk +Amax +Pd >0、す
なわち、目標値Pk が最終目標値Pm より小さく、かつ
最大加速度Amax に基づいて減速したときの速度Vk が
正の値になるか否かを判断し、肯定結果が得られたとき
にはステツプSP102に移つて、次の時刻の速度V
k+1 を0とし、また開始位置P0 を目標値Pk に置き換
えて、上述の場合と逆方向の移動を開始し得るように状
態1に遷移した後、目標値生成装置2はステツプSP9
6に移つてch flag =0にする。In step SP92, the target value generator 2 determines that P k <P m and V k + A max + P d > 0, that is, the target value P k is smaller than the final target value P m and the maximum acceleration A max is reached. Based on the judgment, it is judged whether or not the speed V k at the time of deceleration becomes a positive value, and when a positive result is obtained, the process proceeds to step SP102, and the speed V at the next time is determined.
After k + 1 is set to 0, the start position P 0 is replaced with the target value P k , and after transitioning to the state 1 so that the movement in the opposite direction to the above case can be started, the target value generation device 2 proceeds to step SP9.
Move to 6 and set ch flag = 0.
【0111】やがてステツプSP92において否定結果
が得られると、目標値生成装置2はステツプSP93に
移る。続いて目標値生成装置2は、移動対象を最大減速
して目標値Pk が最終目標値Pm で正確に停止し得るよ
うに調整する。When a negative result is obtained in step SP92, the target value generator 2 proceeds to step SP93. Subsequently, the target value generation device 2 adjusts the moving object to the maximum deceleration so that the target value P k can accurately stop at the final target value P m .
【0112】このステツプSP93において、目標値生
成装置2はVk ≧Pd 、すなわち、前の時刻の速度Vk
が上記停止位置調整のための値Pd 以上であるか否かを
判断し、肯定結果が得られたときにはステツプSP10
3に移つて、前の時刻の速度Vk が次の時刻においても
同じ速度となるように次の時刻の速度Vk+1 をVk とす
る。In this step SP93, the target value generator 2 has V k ≧ P d , that is, the speed V k at the previous time.
Is greater than or equal to the value P d for adjusting the stop position, and if a positive result is obtained, step SP10
3 to the transfer connexion, velocity V k of the previous time is also a V k the velocity V k + 1 of the next time so that the same speed at the next time.
【0113】その後、目標値生成装置2は再度最大加速
することにより、停止位置が定速度における1クロツク
間に移動する距離Vk だけ先に位置することになり、従
つて、続けて最大減速したときの停止位置と最終目標値
Pm との差Pd は小さくなる。これに従つて、このPd
をPd −Vk に置き換えることにより、Pd は次第に小
さくなる。その後、目標値生成装置2はステツプSP9
6に移つてch flag =0にする。やがてステツプSP9
3において否定結果が得られると、目標値生成装置2は
ステツプSP94に移る。After that, the target value generator 2 is again accelerated to the maximum level, so that the stop position is positioned ahead by the distance V k that moves during one clock at a constant speed, and accordingly, the maximum deceleration is continued. At this time, the difference P d between the stop position and the final target value P m becomes small. According to this, this P d
By replacing the P d -V k, P d decreases gradually. After that, the target value generator 2 proceeds to step SP9.
Move to 6 and set ch flag = 0. Eventually step SP9
When a negative result is obtained in 3, the target value generation device 2 moves to step SP94.
【0114】このステツプSP94において、目標値生
成装置2はVk+1 +Pd =Vk +Amax +Pd ≧−A
max 、すなわち、定速度における1クロツク間に移動す
る距離Vk+1 と上記停止位置調整のための値Pd との和
の値が最大加速時における1クロツク間に移動する速度
Amax の負の値以上であるか否かを判断し、肯定結果が
得られたときはステツプSP104に移つて、次の時刻
における速度Vk+1 をVk+1 +Pd =Vk +Amax +P
d と置き換えることにより、目標値Pk+1 を最終目標値
Pm と一致させることができる。その後、目標値生成装
置2はステツプSP96に移つてch flag =0にする。In this step SP94, the target value generator 2 has V k + 1 + P d = V k + A max + P d ≧ −A
max , that is, the sum of the distance V k + 1 moving in one clock at a constant speed and the value P d for adjusting the stop position is negative of the speed A max moving in one clock at maximum acceleration. Is determined to be equal to or greater than the value of V, and if a positive result is obtained, the process proceeds to step SP104 to set the velocity V k + 1 at the next time to V k + 1 + P d = V k + A max + P
The target value P k + 1 can be matched with the final target value P m by replacing it with d . After that, the target value generation device 2 moves to step SP96 and sets ch flag = 0.
【0115】やがてステツプSP94において否定結果
が得られると、目標値生成装置2はステツプSP95に
移る。このステツプSP95において、目標値生成装置
2はVk+1 =Vk +Amax として単純に減速し続けステ
ツプSP96に移る。When a negative result is obtained in step SP94, the target value generator 2 proceeds to step SP95. In this step SP95, the target value generating device 2 simply sets V k + 1 = V k + A max and continues to decelerate, and proceeds to step SP96.
【0116】このステツプSP96において、目標値生
成装置2はch flag =0にした後、ステツプSP9に移
つてstop=1であるか否かを判断し、否定結果が得られ
たときは、目標値生成装置2はステツプSP10に移つ
てk=k+1とした後、再度上述のステツプSP2に戻
つて次の時刻の操作を開始する。やがてステツプSP9
において、目標値生成装置2が肯定結果を得ると、その
ままステツプSP11に移つて当該処理手順を終了す
る。In this step SP96, the target value generator 2 sets ch flag = 0, then moves to step SP9 and determines whether stop = 1, and when a negative result is obtained, the target value is obtained. The generator 2 moves to step SP10 and sets k = k + 1, then returns to step SP2 again and starts the operation at the next time. Eventually step SP9
When the target value generation device 2 obtains a positive result in step S11, the process directly proceeds to step SP11, and the processing procedure ends.
【0117】(10)実施例の動作 以上の構成において、移動対象が移動制御されている間
に最終目標値Pm がPm ′に変更された場合には、目標
値生成装置2は現在の時刻kにおける移動対象の目標値
Pk 及び速度Vk を当該移動対象の加速の度合いごとに
設定された所定の状態としてとらえ、当該状態における
移動対象を目標値変更に対応する状態に遷移することに
より、次の時刻k+1における移動対象の目標値Pk+1
及び速度Vk+1 を順次生成する。(10) Operation of the Embodiment With the above configuration, if the final target value P m is changed to P m ′ while the moving object is being controlled for movement, the target value generating device 2 is captures the target value P k and the velocity V k of the moving object at time k as a predetermined condition set for each degree of acceleration of the moving object, to shift the moving target in the state to the state corresponding to the target value change Thus, the target value P k + 1 of the moving target at the next time k + 1
And the velocity V k + 1 are sequentially generated.
【0118】ここで、上述の目標値変更が加速時及び定
速時においてされた場合には、目標値生成装置2は目標
値Pk+1 及び速度Vk+1 を生成した後、目標値変更前の
各状態における操作と同様の操作を逐次継続してするこ
とにより、移動対象を変更後の最終目標値Pm ′で停止
させることができる。Here, when the above-mentioned target value change is performed during acceleration and at constant speed, the target value generator 2 generates the target value P k + 1 and the speed V k + 1 , and then the target value. By successively continuing the same operation as the operation in each state before the change, the moving target can be stopped at the changed final target value P m ′.
【0119】一方、上述の目標値変更が減速時において
された場合には、目標値生成装置2は目標値Pk+1 及び
速度Vk+1 を生成した後、移動対象を最大減速しても、
当該移動対象の減速を開始する位置によつては必ずしも
変更後の最終目標値Pm ′で当該移動対象を停止できる
とは限らない。On the other hand, when the above-mentioned target value change is performed during deceleration, the target value generator 2 generates the target value P k + 1 and the speed V k + 1 and then decelerates the moving object to the maximum. Also,
Depending on the position where the deceleration of the moving target is started, the moving target cannot always be stopped at the changed final target value P m ′.
【0120】このため目標値生成装置2は、移動対象の
減速を開始する際に、最大減速したときの目標値Pk の
停止位置と変更後の最終目標値Pm ′とのずれを演算し
て当該演算値を記憶しておき、この記憶された演算値に
基づいて減速中の移動対象の速度が所定の値になつたら
1クロツクだけ定速走行して、このときの目標値Pkの
停止位置と変更後の最終目標値Pm ′とのずれを演算し
て当該演算値を新たに記憶しておくようにする。Therefore, when starting deceleration of the object to be moved, the target value generator 2 calculates the deviation between the stop position of the target value P k at the time of maximum deceleration and the changed final target value P m ′. The calculated value is stored in advance, and when the speed of the moving object during deceleration reaches a predetermined value on the basis of the stored calculated value, the vehicle travels at a constant speed for one clock to obtain the target value P k at this time. The difference between the stop position and the changed final target value P m ′ is calculated and the calculated value is newly stored.
【0121】このように目標値生成装置2は上述のよう
な操作を繰り返すことにより、目標値Pk の停止位置と
変更後の最終目標値Pm ′とのずれを次第に小さくする
ことができ、この結果、移動対象を変更後の最終目標値
Pm ′で停止させることができる。As described above, the target value generating device 2 can gradually reduce the deviation between the stop position of the target value P k and the changed final target value P m ′ by repeating the above-mentioned operation, As a result, the movement target can be stopped at the changed final target value P m ′.
【0122】(11)実施例の効果 以上の構成によれば、移動対象が移動制御されている間
に目標値変更がなされた場合に、目標値生成装置2は現
在の時刻kにおける移動対象の目標値Pk 及び速度Vk
に基づいて次の時刻の目標値Pk+1 のみを順次生成する
ような操作をすることにより、変更後の最終目標値
Pm ′までの目標軌道を生成することができる。(11) Effects of the Embodiments According to the above configuration, when the target value is changed while the movement target is being controlled for movement, the target value generation device 2 sets the movement target at the current time k. Target value P k and speed V k
The target trajectory up to the changed final target value P m ′ can be generated by performing an operation to sequentially generate only the target value P k + 1 at the next time based on
【0123】かくして目標値生成装置2は目標値変更の
際に行われる目標軌道生成の演算の負荷が一時に集中す
ることなく分散されるため、当該演算量が少なくて済む
ことになり、従つて比較的早いサンプルクロツクにおい
て目標値変更に対応した処理をすることができる。Thus, in the target value generating device 2, the load of the calculation of the target trajectory generated when the target value is changed is dispersed without being concentrated at one time, so that the calculation amount can be reduced, and accordingly, The processing corresponding to the change of the target value can be performed in the sample clock which is relatively fast.
【0124】[0124]
【発明の効果】上述のように本発明によれば、移動対象
が移動制御されている間に目標値の変更がなされた場合
に、変更後の目標値に基づいて移動対象の現在位置から
1クロツク経過後の位置を順次作成し、移動対象の減速
時においては、移動対象の停止位置と変更後の目標値と
のずれを演算した後に当該ずれを小さくする操作を繰り
返すようにしたことにより、比較的簡単に目標値変更に
対応した処理をすることができる。As described above, according to the present invention, when the target value is changed while the movement target is being controlled for movement, 1 is calculated from the current position of the movement target based on the changed target value. By sequentially creating positions after the clock has elapsed, and during deceleration of the moving object, by calculating the deviation between the stop position of the moving object and the changed target value, and then repeating the operation to reduce the deviation, The process corresponding to the change of the target value can be performed relatively easily.
【図1】本発明によるデイジタル位置制御サーボ装置の
一実施例を示すブロツク図である。FIG. 1 is a block diagram showing an embodiment of a digital position control servo device according to the present invention.
【図2】目標値変更しない場合における目標軌道を示す
略線図である。FIG. 2 is a schematic diagram showing a target trajectory when a target value is not changed.
【図3】本発明による目標値変更における移動対象の遷
移を示す状態遷移図である。FIG. 3 is a state transition diagram showing a transition of a movement target in changing a target value according to the present invention.
【図4】本発明による目標値変更における移動対象の遷
移を示す状態遷移図である。FIG. 4 is a state transition diagram showing a transition of a movement target in changing a target value according to the present invention.
【図5】本発明による目標値変更をした場合における目
標軌道を示す略線図であるFIG. 5 is a schematic diagram showing a target trajectory when a target value is changed according to the present invention.
【図6】本発明における全体の処理手順を示すフローチ
ヤートである。FIG. 6 is a flow chart showing the overall processing procedure in the present invention.
【図7】本発明における目標値生成装置の操作の処理手
順を示すフローチヤートである。FIG. 7 is a flow chart showing a processing procedure of an operation of the target value generation device in the present invention.
【図8】本発明における目標値生成装置の操作の処理手
順を示すフローチヤートである。FIG. 8 is a flow chart showing a processing procedure of an operation of the target value generation device in the present invention.
【図9】本発明における目標値生成装置の操作の処理手
順を示すフローチヤートである。FIG. 9 is a flow chart showing a processing procedure of an operation of the target value generation device in the present invention.
【図10】本発明における目標値生成装置の操作の処理
手順を示すフローチヤートである。FIG. 10 is a flow chart showing a processing procedure of an operation of the target value generation device according to the present invention.
【図11】本発明における目標値生成装置の操作の処理
手順を示すフローチヤートである。FIG. 11 is a flow chart showing a processing procedure of an operation of the target value generation device according to the present invention.
【図12】本発明における目標値生成装置の操作の処理
手順を示すフローチヤートである。FIG. 12 is a flow chart showing a processing procedure of an operation of the target value generation device according to the present invention.
1……デイジタル位置制御サーボ装置、2……目標値生
成装置、3……サーボコントローラ、4……エンコー
ダ、5……モータ。1 ... Digital position control servo device, 2 ... Target value generation device, 3 ... Servo controller, 4 ... Encoder, 5 ... Motor.
Claims (3)
置に対して移動対象を移動制御する数値制御装置におい
て、 上記移動対象が移動制御されている間に上記目標値の変
更がなされた場合に、上記変更後の目標値に基づいて移
動対象の現在位置から1クロツク経過後の位置信号を順
次生成する目標値生成装置と、 上記目標値生成装置から送出される位置信号を符号部か
ら送出される出力信号と一致させることによつて得られ
る制御信号に基づいてサーボ駆動するサーボ制御部とを
具えたことを特徴とする数値制御装置。1. A numerical controller for controlling the movement of a moving object with respect to a target position represented by a set target value, wherein the target value is changed while the moving object is being controlled for movement. In this case, a target value generation device that sequentially generates a position signal after one clock has elapsed from the current position of the moving target based on the changed target value, and a position signal sent from the target value generation device are encoded by a coding unit And a servo control section for servo-driving based on a control signal obtained by matching the output signal sent from the numerical control apparatus.
置に対して移動対象を移動制御する数値制御装置におい
て、 上記移動対象が移動制御されている間に上記目標値の変
更がなされた場合に、上記変更後の目標値に基づいて移
動対象の現在位置から1クロツク経過後の位置を順次生
成し、 移動対象の減速時においては、移動対象の停止位置と変
更後の目標値とのずれを演算した後に当該ずれを小さく
する操作を繰り返すようにしたことを特徴とする数値制
御装置。2. A numerical controller for controlling the movement of a moving object with respect to a target position represented by a set target value, wherein the target value is changed while the moving object is being controlled. In this case, the position after one clock has elapsed is sequentially generated from the current position of the moving object based on the changed target value, and when decelerating the moving object, the stop position of the moving object and the changed target value are A numerical controller characterized in that an operation for reducing the deviation is repeated after the deviation is calculated.
置に対して移動対象を移動制御する数値制御装置におい
て、 上記移動対象が移動制御されている間に上記目標値の変
更がなされた場合に、上記変更後の目標値に基づいて移
動対象の現在位置から1クロツク経過後の位置信号を順
次生成し、 上記目標値生成装置から送出される位置信号を符号部か
ら送出される出力信号と一致させることによつて得られ
る制御信号に基づいてサーボ駆動するようにしたことを
特徴とする数値制御方法。3. A numerical controller for controlling the movement of a moving object with respect to a target position represented by a set target value, wherein the target value is changed while the moving object is being controlled for movement. In this case, the position signal after one clock has elapsed from the current position of the moving object is sequentially generated based on the changed target value, and the position signal transmitted from the target value generation device is output from the encoding unit. A numerical control method characterized in that servo drive is performed based on a control signal obtained by matching the signal.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP35075093A JPH07200063A (en) | 1993-12-29 | 1993-12-29 | Munerical control device and method therefor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP35075093A JPH07200063A (en) | 1993-12-29 | 1993-12-29 | Munerical control device and method therefor |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH07200063A true JPH07200063A (en) | 1995-08-04 |
Family
ID=18412614
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP35075093A Pending JPH07200063A (en) | 1993-12-29 | 1993-12-29 | Munerical control device and method therefor |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH07200063A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2016173708A (en) * | 2015-03-17 | 2016-09-29 | アズビル株式会社 | Control device and control method |
-
1993
- 1993-12-29 JP JP35075093A patent/JPH07200063A/en active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2016173708A (en) * | 2015-03-17 | 2016-09-29 | アズビル株式会社 | Control device and control method |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3477015B2 (en) | Inter-vehicle distance control device | |
US5502639A (en) | Controlling apparatus of steering angle of rear wheels of four-wheel steering vehicle | |
JPH0654366B2 (en) | Zooming method and zooming device | |
JP4414383B2 (en) | Automatic train driving device and adjustment method thereof | |
CN110893850A (en) | Vehicle longitudinal speed planning method and longitudinal speed planning device | |
JPH07200063A (en) | Munerical control device and method therefor | |
US20060089748A1 (en) | Method and device to generate position profile in motion controller | |
FR2462737A1 (en) | METHOD AND DEVICE FOR SERVICING THE DISPLACEMENT OF A MACHINE ELEMENT | |
WO2005122385A1 (en) | Motor controller and motor controlling method | |
JP2006291863A (en) | Vehicle driving force control device | |
JPS5945515A (en) | Method for controlling position of motor | |
JP3058058B2 (en) | Vehicle front object detection device | |
CN115454100A (en) | Global speed planning method, global speed planning device and planning system | |
JP2004362022A (en) | Moving body | |
CN113311834B (en) | Automatic driving track tracking method, system and storage medium | |
JP2020069866A (en) | Vehicle control device | |
JP7354170B2 (en) | Vehicle control device and vehicle control method | |
US4831320A (en) | Duty factor control method | |
JP2768696B2 (en) | Servo motor control device | |
JPH05107076A (en) | Drive controller for vehicle | |
JP2024072644A (en) | Steering control device | |
CN118046961A (en) | Steering control device | |
JPH03173303A (en) | Automatic train controller | |
JP2002224977A (en) | Controller for robot, control method and robot | |
JPH05324085A (en) | Head positioning controller |