JPH01270114A - 回転体の位置決め制御用パルス発生器 - Google Patents

回転体の位置決め制御用パルス発生器

Info

Publication number
JPH01270114A
JPH01270114A JP9948188A JP9948188A JPH01270114A JP H01270114 A JPH01270114 A JP H01270114A JP 9948188 A JP9948188 A JP 9948188A JP 9948188 A JP9948188 A JP 9948188A JP H01270114 A JPH01270114 A JP H01270114A
Authority
JP
Japan
Prior art keywords
positioning
travel
position data
control
pulse generator
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
Application number
JP9948188A
Other languages
English (en)
Inventor
Seiji Shinoda
誠司 篠田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fuji Electric Co Ltd
Original Assignee
Fuji Electric Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fuji Electric Co Ltd filed Critical Fuji Electric Co Ltd
Priority to JP9948188A priority Critical patent/JPH01270114A/ja
Publication of JPH01270114A publication Critical patent/JPH01270114A/ja
Pending legal-status Critical Current

Links

Landscapes

  • Control Of Position Or Direction (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 〔産業上の利用分野〕 この発明は回転体の位置決めサーボ系制御用プログラマ
ブルパルス発生器に関する。
〔従来の技術〕
従来のこの種制御用パルス発生器の制御対象となる位置
決めサーボ系としては第7図の直線動作サーボ系構成図
に例示するものを制御動作の基本として構成された第8
図の回転動作サーボ系構成図に例示するものが知られて
いる。
第7図において、11は前記サーボ系の操作動力要素で
あるサーボモータ、12は位置決め対象13の移動用ボ
ールネジである。該位置決め対象13はその最大移動点
Pma xとその移動起点Pm1n間を前記ボールネジ
12に沿って直線上に往復制御される。
第8図において、11は第7図と同じくサーボモータ、
12aは位置決め対象13aの回転駆動用のタイミング
ベルトである。該位置決め対象13aはその最大移動点
Pma xとその移動起点Pm1n間を矢印1又は矢印
2の方向に左右或いは正逆転駆動され、前記画点Pma
 xとP m i n間にある境界点Pzを通過するこ
とはない。
〔発明が解決しようとする課題〕
しかしながら第8図に示す如き従来方式による回転体の
位置決め制御においては、第7図に示す直線状移動1t
制御を制御方式の基本とするため泣面決め対象の移動時
前記境界点Pzを通過することができず、従って前記の
点Pma xと点Pmln間の距離を最大値とする移動
距離を必要とした。
第8図において位置決め対象134を点Paより点pb
へ移行させる場合、矢印1に従い右廻りに点Pbに至る
場合の移動距離は、もし前記境界点Pzの通過が可能な
らば矢印2に従って左廻りに該境界点Pzを経由して点
Pbに至る場合の移動距離に比較して長(なる。従って
前記両者の移動速度を同一とすれば移動所要時間に関し
前者は後者より長くなる。これに鑑み本発明は位置決め
対象の移動起点と移動目標点との相対関係如何にかかわ
らず常に最短距離による移行を可能とする制御信号を位
置決め装置に指令する回転体の位置決め制御用パルス発
生器の提供を目的とするものである。
〔課題を解決するための手段〕
位置決め対象の移動経路における前記境界点通過に関す
る制約を外し、移動の起点と目標点(設定位置)間の所
要移行距離を常に最短となす方向への方向指定と移動量
指定とを行なう演算制御手段を設けるものである。
すなわち複数の位置データを設定する設定器と、位置決
め装置からの現在位置データと他の制御装置からの動作
指令信号とを入力とする信号送受信回路と、前記位置デ
ータの設定値と現在値とを記憶する記憶回路と、演算制
御B回路と、前記位置決め装置に対する指令パルスの制
御カウンタとを備えた回転体の位置決めサーボ系制御装
置の制御用パルス発生器において、位置決め動作開始指
令により前記の設定位置データと現在位置データとを前
記演算制御回路にて比較演算し、前記位置決め動作を最
短の移動距離と時間とにて完了する近廻り位置決め経路
を決定し、前記サーボ系の操作電動機等の操作動力要素
に対する左右或いは正逆転等の操作方向指定と所要移動
距離に対応する操作パルス量の指定とを前記指令パルス
の制御カウンタに対し行なって前記位置決め装置を制御
することを特徴とするものである。
〔作用〕
円周上の2点間を円周に沿いその方向を間はず移行する
場合の最短移動経路の選択は、一方の点から他の点に至
る2組の移動経路の長短比較により行なえばよく、また
該長短比較は前記2組中の何れか1組の移動経路の長さ
と前記円周の1/2の長さとの比較により行なうことが
できる。
本発明は回転動作を行なう位置決め対象の描く円周上の
各点に該円周上の一点を起点とする位置データを与え、
更に前記円周上の2点として前記位置決め対象の移動起
点と移動目標点とを対応させ、該画点間長さと前記円周
の1/2長さとの長短比較演算を行ない、該演算結果の
正負符号より前記最短移動経路への移動方向の決定を行
ない、更に該移動方向に対応した経路すなわち前記最短
移動経路の長さの演算を行なうものであり、以上の諸演
算を位置データの記憶回路のデータを用いCPU等の演
算制御回路にて行なうものである。
〔実施例〕
以下この発明の実施例を図面により説明する。
第1図は前記制御用パルス発生器のブロック回路図、第
2図と第4図とはそれぞれ回転体動作図の(I)と(I
t)とであり、第3図と第5図と第6図とはそれぞれ近
廻り移動経路選択用の演算フローチャートの(I)と(
I[)と(III)とである。
第1図において1は移動目標点の設定器、2は表示器、
3はCPU等の演算制御回路、4は位置データの記憶回
路、9はスタート指令或いは前記設定器lにより指定さ
れた移動目標点位置データに対応する目標位置階等の諸
指令を与えるシーケンサであり、10は回転体の位置決
め制御を行なうと共に該回転体の現在位置データを発す
る位置決め装置である。5は該位置決め装置10に対す
る指令パルス信号を発するパルス制御カウンタであり、
6は前記シーケンサ9からの諸指令と前記位置決め装置
10からの回転体現在位置データとの信号処理用の送受
信回路であり以上1〜6に至る諸要素は共通バス7を介
して接続される。8は前記各要素1〜7より成る位置決
め制御用パルス発生器である。
次に第2図の回転体動作図(1)は、前記回転体の移動
経路である円周上の各点に位置データを与え、該位置デ
ータにより回転体の位置決め動作を行なう場合の例示で
あり、原点であり且つ円周−周後の最大点でもある位置
データ0或いは7000の点を基準とし移動起点である
位置データ1000の現在位Tll (N11l )か
ら位置データ5000の目標位置(隘2)への移動状態
を示す。該両位置間の移動経路には図示矢印の如(左廻
りの遠廻り経路と右廻りの近廻り経路とがあるが、該両
経路からの前記近廻り経路の選択は第3図の演算フロー
チャート(1)の如く行なわれ、移動方向(指令パルス
信号の正逆)と移動量(指令パルス数)とが決定される
第3図においてシーケンサ9より前記の目標位置嵐とス
タート指令とが与えられると、前記各位置データを用い
、まずステップ1において前記の目標位置と現在位置と
の差を下記式1により演算する。
(目標位置データ)=(現在位置データ)・・・式1 次にステップ2において前記ステップ1の演算結果が前
記近廻り経路の条件である下記の式2に合致する(Ye
s)か否(NO)かを判定する。
1 (目標位置データ)−(現在位置データ)1く(最
大位置データ)/2・・・式2 式2に合致した場合に前記のパルス制御カウンタ5を介
して位置決め装置10に与えられる指令パルスの方向を
近廻り経路の移動方向とし、式lの演算結果に対応する
パルス数をその移動量とする。
逆に式2による判定が否(No)の場合、ステップ3に
おける前記近廻り経路の移動方向は前記ステップ2の合
致(Yes)の場合と逆方向とし、その移動量はステッ
プ4において下記の式3に従って演算する。
(最大点位置データ)− 1(目標位置データ)−(現在位置データ)1・・・式
3 因に第2図の各データを式1〜式3に従って算定すれば
次の如くなる。式1 : 5000−1000=400
0、式2 : + 5000−10001 =4000
>7000/ 2 (、否、No) 、式3 : 70
00−15000−10001 =3000、すなわち
前記近廻り経路は、弐2合致(Yes)の場合を左廻り
として、位置データO或いは7000の最大点を経由し
位置データ差3000の右廻り経路となる。
次に第4図の回転体動作図(II)は図示の経路■−〇
−Oの如く一方向に連続位置決め動作を行なう場合の例
示である。図示の如く一方向の連続位置決め制御を行な
う場合、前記位置決め装置1゜における現在位置データ
は例えば−周7000を単位に蓄積され、多回転と共に
前記装置1oにおけるデータカウントはオーバーフロす
る事態に至り正確な位置決め制御は不能となる。
該オーバーフロー回避のために、第5図の演算フローチ
ャート(■)に示す如(、前記一方向の移動経路におけ
る各目標位置毎に前記位置決め装置10における現在位
置データを内部メモリである前記記憶回路4に移し、移
行完了と共に前記装置10のデータ内容をクリアする。
従って前記装置10における位置データは第4図におい
て7000にて例示する前記最大点位置データを最大と
して変化し、その値は前記各目標位置間の移動量を示す
ものとなる。なお上記データ移行に伴ない前記の式1〜
式3における現在位置データは弐4により新たに演算さ
れた値に置換される。
(現在位置データ)=(内部メモリデータ)+(位置決
め装置10の現在位置データ)・・・式4なお第5図ス
テップ3における現在位置データは8000となりその
実際値1000と異なる値をを示す。
この場合は第6図の演算フローチャート(TI[)に従
って補正する。すなわち第5図における現在位置データ
Aが前記最大点位置データBに対しA≧Bでない(NO
)ならば該データ八をそのまま所要の現在位置データと
し、A≧Bならば(Yes)A−Bを以って所要の現在
位置データとなすもののである。
〔発明の効果〕
この発明によれば回転体の位置決めサーボ系の制御回路
において、位置決め対象の移動する円周」二の移動起点
から移動目標点に至る近廻り移動経路を選択する演算制
御を行なうことにより、前記位置決め対象の移動目標点
迄の移動所要時間の短縮と面記位置決めサーボ系に対応
動作する機械側の待ち時間の短縮とが共に可能となる。
【図面の簡単な説明】
第1図より第6図に至る各図はこの発明の実施例を示す
ものであり、第1図は回転体の位置決め制御用パルス発
生器のブロック回路図、第2図と第4図とはそれぞれ回
転体動作図の(1)と(n)とであり、第3図と第5図
と第6図とはそれぞれ近廻り移動経路選択用の演算フロ
ーチャートの(1)と(II)と(I[I)とである。 第7図と第8図とは従来技術による位置決めサーボ系の
実施例であり、第7図は直線動作サーボ系構成図、第8
図は回転動作サーボ系構成図である。 1・・・設定器、2・・・表示器、3・・・演算制御回
路、4・・・記憶回路、5・・・パルス制御カウンタ、
6・・・送受信回路、7・・・共通バス、8・・・位置
決め制御用パルス発生器、9・・・シーケンサ、10・
・・位置決め装置、11・・・サーボモータ、12・・
・ボールネジ、12a・・・タイミングベルト、13.
13a・・・位置決め対象、Pma x・・・最大移動
点、Pm1n・・・移第 1 図 (1,000ン 第2 図 官3 図 第4図 第5図 第6図

Claims (1)

    【特許請求の範囲】
  1. 1)複数の位置データを設定する設定器と、位置決め装
    置からの現在位置データと他の制御装置からの動作指令
    信号とを入力とする信号送受信回路と、前記位置データ
    の設定値と現在値とを記憶する記憶回路と、演算制御回
    路と、前記位置決め装置に対する指令パルスの制御カウ
    ンタとを備えた回転体の位置決めサーボ系制御装置の制
    御用パルス発生器において、位置決め動作開始指令によ
    り前記の設定位置データと現在位置データとを前記演算
    制御回路にて比較演算し、前記位置決め動作を最短の移
    動距離と時間とにて完了する近廻り位置決め経路を決定
    し、前記サーボ系の操作電動機等の操作動力要素に対す
    る左右或いは正逆転等の操作方向指定と所要移動距離に
    対応する操作パルス量の指定とを前記指令パルスの制御
    カウンタに対し行なって前記位置決め装置を制御するこ
    とを特徴とする回転体の位置決め制御用パルス発生器。
JP9948188A 1988-04-22 1988-04-22 回転体の位置決め制御用パルス発生器 Pending JPH01270114A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP9948188A JPH01270114A (ja) 1988-04-22 1988-04-22 回転体の位置決め制御用パルス発生器

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP9948188A JPH01270114A (ja) 1988-04-22 1988-04-22 回転体の位置決め制御用パルス発生器

Publications (1)

Publication Number Publication Date
JPH01270114A true JPH01270114A (ja) 1989-10-27

Family

ID=14248503

Family Applications (1)

Application Number Title Priority Date Filing Date
JP9948188A Pending JPH01270114A (ja) 1988-04-22 1988-04-22 回転体の位置決め制御用パルス発生器

Country Status (1)

Country Link
JP (1) JPH01270114A (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04326104A (ja) * 1991-04-25 1992-11-16 Matsushita Electric Ind Co Ltd ロボットの制御装置

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5775752A (en) * 1980-10-30 1982-05-12 Fanuc Ltd Main shaft rotary position control system
JPS5991514A (ja) * 1982-11-16 1984-05-26 Okuma Mach Works Ltd 主軸定位置停止制御方法及び装置
JPS6222116A (ja) * 1985-07-19 1987-01-30 Tsudakoma Ind Co Ltd 円テ−ブル等の角度設定制御方法とその装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5775752A (en) * 1980-10-30 1982-05-12 Fanuc Ltd Main shaft rotary position control system
JPS5991514A (ja) * 1982-11-16 1984-05-26 Okuma Mach Works Ltd 主軸定位置停止制御方法及び装置
JPS6222116A (ja) * 1985-07-19 1987-01-30 Tsudakoma Ind Co Ltd 円テ−ブル等の角度設定制御方法とその装置

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04326104A (ja) * 1991-04-25 1992-11-16 Matsushita Electric Ind Co Ltd ロボットの制御装置

Similar Documents

Publication Publication Date Title
US6138063A (en) Autonomous vehicle always facing target direction at end of run and control method thereof
CN110162029B (zh) 一种基于规划路径的运动控制方法及装置、机器人
JPH04333902A (ja) 清掃機の自動走行清掃方式
JP7019179B2 (ja) 圃場作業車両の走行経路設定装置、圃場作業車両、圃場作業車両の走行経路設定方法および走行経路設定用プログラム
JP2002078650A (ja) 自走式掃除機
CN111915106B (zh) 一种路径生成方法、装置、晶面机及存储介质
JP3544789B2 (ja) モータ制御装置及び画像読み取り装置の走行体駆動装置
JPH0655037B2 (ja) サーボモータの速度制御方法
Austin Generate stepper-motor speed profiles in real time
EP0135772B1 (en) Operation control apparatus for robots
JPH01270114A (ja) 回転体の位置決め制御用パルス発生器
JP3583588B2 (ja) 移動体の制御装置
CN114995464B (zh) 局部路径规划的控制方法及装置、机器人、存储介质
JPH0127443B2 (ja)
JPH01140310A (ja) ロボットの制御方法
KR0161027B1 (ko) 로보트의 자동주행제어장치 및 그 방법
JP2004362022A (ja) 移動体
JPS6054207B2 (ja) 移動走行式コンベヤの制御装置
JPS6215610A (ja) 自律走行ロボツトの走行制御方法
CN109048895B (zh) 一种巡游方法和巡游机器人
JPS6234210A (ja) 原点位置の検出装置
JPS59149796A (ja) ステツピングモ−タ制御方式
JPS6362007A (ja) 移動体の操舵指令信号発生装置
JPH06309038A (ja) ロボットの軌道計画方法
JPH0424803A (ja) 並列分散制御装置