JPH08194541A - 位置制御装置 - Google Patents

位置制御装置

Info

Publication number
JPH08194541A
JPH08194541A JP7007656A JP765695A JPH08194541A JP H08194541 A JPH08194541 A JP H08194541A JP 7007656 A JP7007656 A JP 7007656A JP 765695 A JP765695 A JP 765695A JP H08194541 A JPH08194541 A JP H08194541A
Authority
JP
Japan
Prior art keywords
position data
data
control
servo
timer
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP7007656A
Other languages
English (en)
Other versions
JP3434065B2 (ja
Inventor
Sumio Yamamoto
純生 山本
Kenji Hara
憲二 原
Haruo Omura
春男 大村
Koji Hasegawa
宏治 長谷川
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.)
Yaskawa Electric Corp
Toyoda Koki KK
Original Assignee
Yaskawa Electric Corp
Toyoda Koki KK
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 Yaskawa Electric Corp, Toyoda Koki KK filed Critical Yaskawa Electric Corp
Priority to JP00765695A priority Critical patent/JP3434065B2/ja
Publication of JPH08194541A publication Critical patent/JPH08194541A/ja
Application granted granted Critical
Publication of JP3434065B2 publication Critical patent/JP3434065B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Control Of Position Or Direction (AREA)
  • Numerical Control (AREA)
  • Feedback Control In General (AREA)
  • Programmable Controllers (AREA)

Abstract

(57)【要約】 【目的】 サーボ制御ユニット部の同期信号とサーボ部
でのエンコーダ出力のサンプリングタイミングとの同期
が補間により実現すること。 【構成】 一定周期で位置データを出力する位置検出手
段と、前記一定周期より遅い周期で位置データを読み込
んで位置制御を行うサーボ系制御手段と、前記位置デー
タを出力したときに計時をスタートし、前記制御手段に
よる位置データの読み込みでタイマデータを出力するタ
イマ手段と、前記タイマデータに基ずいて前記位置検出
手段の位置データを補正し、補正された位置データを前
記制御手段に出力する位置データ処理手段とから成るこ
とを特徴とする位置制御装置。

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は、位置データ信号を補間
出力する位置制御装置に関し、特に、メインシステムに
おける同期タイミングに対してエンコーダ位置データの
サンプリングタイミングが時間的にずれている場合に、
さらにずれ分の位置データを補間して同期タイミングで
出力する位置制御装置に関するものである。
【0002】
【従来の技術】従来技術について説明する。図2は、C
NC装置の一構成を示すブロック図である。同図におい
て、20はコンピュータ等から成る中央のCNC装置本
体、21、21、・・は装置本体20に接続された複数
のサーボ制御ユニット部である。22、22、・・は各
サーボ制御ユニット部に設けられた複数のサーボ部であ
り、さらに各サーボ部22、22・・には位置帰還用の
エンコーダ24、24、・・を内蔵したサーボモータ2
3、23、・・が設けられている。これらによって各モ
ータ毎に送り軸等の位置サーボ系の帰還制御が行われ
る。このような複数の送り軸を関連付けて制御するCN
C装置において、全軸の同期性の精度を上げる為、位置
検出手段からの高応答のデータを読み込む機能、又は位
置検出手段に同期信号を送り、その時点のデータを読み
込む機能が必要で、そのために位置検出器及びデータ伝
送系が高価になっていた。
【0003】位置検出器及びデータ伝送系を安価で安定
な比較的低周期の独立時間周期データ方式(例えばシリ
アル伝送方式など)にすると、位置ループ処理の同期信
号とエンコーダ位置データのサンプリングタイミング信
号との同期がとれず、位置制御の精度が悪くなる。位置
ループ処理の同期信号とエンコーダ位置データのサンプ
リングタイミング信号とに同期性がないことについて、
図3を用いて説明する。図3(a)は、CNC装置本体
より複数の各サーボ制御ユニット部に送信される周期T
2の同期信号を示す。図3(b)は、時間につれて移動
する位置を周期T1でサンプリングするエンコーダの出
力信号を示すが、図のように階段状になる。また、同期
信号a2,a3の受信時にエンコーダのサンプリング値は
b3,b6であり、同期信号とサンプリングタイミングと
の同期ずれt1,t2に伴う位置データの誤差が傾斜した点
線で示す実際の値との間に見られる。この誤差分が位置
制御の精度を悪くしているのである 又、複数軸の同時性でみると図3(a),(b)に示す
a2のタイミングでは1軸はTb2の時刻のデータ、2軸
はTc3の時刻のデータとなり、軸間のデータ精度がば
らばらになる。
【0004】
【発明が解決しようとする課題】本発明の目的は、従来
技術の上記欠点を解決するもので、(1)位置制御ルー
プに於て、位置検出手段からのデータが同期信号に同期
されたものになり高精度の位置制御が可能とすること、
(2)サーボ制御ユニット部の同期信号とサーボ部での
エンコーダ出力のサンプリングタイミングとの同期が補
間により実現することで、少なくとも2軸送り時の位置
制御の精度を上げることにある。
【0005】
【課題を解決するための手段】上記目的を達成するため
に、本発明は、一定周期で位置データを出力する位置検
出手段と、前記一定周期より遅い周期で位置データを読
み込んで位置制御を行うサーボ系制御手段と、前記位置
データを出力したときに計時をスタートし、前記制御手
段による位置データの読み込みでタイマデータを出力す
るタイマ手段と、前記タイマデータに基ずいて前記位置
検出手段の位置データを補正し、補正された位置データ
を前記制御手段に出力する位置データ処理手段とから成
ることを特徴とする位置制御装置にある。
【0006】
【作用】本発明によれば、位置検出手段とサーボ系制御
手段との間に、タイマー手段及び位置データ処理手段を
設けることによって、タイマーは、位置検出手段が位置
データを出力した時に計時を始動し、制御手段による位
置データの読み込み時までの時間を求める。位置データ
処理手段では、求めた時間と位置データの出力周期との
対比から、求めた時間に対応する位置データ分を比例配
分に基づいて求め、この位置データ分をタイマー始動時
の既知位置データに加算する。これによって、位置検出
手段からの位置データは制御手段の読み込み時における
値に補正して出力することができる。
【0007】
【実施例】本発明の実施例について説明する。図1は、
実施例の構成を示すブロック図である。なお、図1は図
2の一つのサーボ制御ユニット部について示している。
同図において、1はCNC装置本体に複数接続される内
の1つであるサーボ制御ユニット部で、位置データ処理
部5、位置データバッファ6、制御部7および タイマ
ー8とから成る。2はサーボアンプ部で、制御部7から
の制御指令を受けてサーボモータ3に制御電流を流す。
4はサーボモータに内蔵などされたエンコーダで、モー
タによる送り位置を一定周期でディジタル信号化してサ
ーボ制御ユニット部1に出力する。6はエンコーダより
送られてくる位置データを記憶するバッファである。5
はCNC装置本体からの同期信号によりバッファ6から
位置データを読み取り、またタイマ8よりタイマデータ
を読み取り、位置データを補正処理してからCNC装置
本体へ送る機能を有する位置データ処理部である。7は
制御部で、CNC装置本体より速度指令等の制御信号を
受取り、サーボアンプ部2へモータ制御指令を送る。8
はタイマで、エンコーダ4からの位置データをバッファ
6が受信する度にクリアされてスタートし、CNC装置
本体からの同期信号で位置データ処理部5によりタイマ
データが読み出されるまで計時する。
【0008】つぎに、実施例の動作について説明する。
まず、図3を用いて概要を説明すると、図3(c)は、
時間につれて移動する位置を周期T1でサンプリングす
るエンコーダの出力信号を示す。(c)が(b)と異な
る点は、同期信号aを受信する時にある。即ち、エンコ
ーダが位置データをサンプリングした時から同期信号を
受信するまでの時間t1,t2を計時する。求めた時間t1
とサンプリング周期T1との比から、時間t1に対応する
位置データ分を比例配分して求め、これを位置データ値
b3に加算して補間位置データ値B4を算出する。算出さ
れたデータ値は、実際の値を示す点線と同期信号のタイ
ミングとの交点の値に一致する。これらの処理は、主に
タイマ8および位置データ処理部5によってなされる。
CNC装置本体より速度指令等の制御信号を受取ると、
制御部7はサーボアンプ部2へモータ制御指令を送る。
モータ制御指令を受けたサーボアンプ部2はサーボモー
タ3に電流を流し、モータ3を駆動して送り軸等によっ
て位置制御を行う。移動による位置データはエンコーダ
4によって一定周期で検出されて位置データバッファ6
に送られる。バッファ6に位置データが送られる度に、
タイマ8はクリアされて計時をスタートし、計時される
タイマデータはCNC装置本体からの同期信号で位置デ
ータ処理部5により読み出される。
【0009】位置データ処理部5では、CNC装置本体
からの位置信号によりバッファ6から位置データを、ま
たタイマ8からタイマデータを、それぞれ読み出す。さ
らに位置データ処理部5では、読み出したタイマデータ
と位置データが検出される一定周期との比からタイマデ
ータ分に対応する位置データ分を比例配分に基づいて演
算して求める。求めた位置データ分は読み出した位置デ
ータに加算されることによって、エンコーダから一定周
期で検出される位置データは、同期信号の発生時に対応
した位置データに補正されてからCNC装置本体に出力
される。CNC装置本体は補正位置データを目標値と比
較し、その偏差より新たな制御信号に基づいて制御を継
続して行う。これまで説明した実施例の構成を図2に示
す各サーボ制御ユニット部系について採用することによ
り、各サーボ制御ユニット部と各制御端との同期が取り
易くなる。
【0010】
【発明の効果】本発明によれば、サーボ制御ユニット部
とサーボ部(エンコーダ位置データのサンプリング)と
の同期が補間により実現され、同時に2軸送り時の2軸
間の位置制御精度が向上する効果を奏する。
【図面の簡単な説明】
【図1】実施例の構成を示すブロック図
【図2】CNC装置の構成を示すブロック図
【図3】位置データについて説明するためのタイムチャ
ート
【符号の説明】
1 サーボ制御ユニット部 2 サーボアンプ部 3 サーボモータ 4 エンコーダ 5 位置データ処理部 6 位置データバッファ 7 制御部 8 タイマー 20 CNC装置本体 21 サーボ制御ユニット部 22 サーボ部 23 サーボモータ 24 エンコーダ
─────────────────────────────────────────────────────
【手続補正書】
【提出日】平成7年2月3日
【手続補正1】
【補正対象書類名】明細書
【補正対象項目名】特許請求の範囲
【補正方法】変更
【補正内容】
【特許請求の範囲】
フロントページの続き (51)Int.Cl.6 識別記号 庁内整理番号 FI 技術表示箇所 G05B 19/05 19/404 21/02 Z 7531−3H (72)発明者 大村 春男 愛知県刈谷市朝日町1丁目1番地 豊田工 機株式会社内 (72)発明者 長谷川 宏治 愛知県刈谷市朝日町1丁目1番地 豊田工 機株式会社内

Claims (2)

    【特許請求の範囲】
  1. 【請求項1】 一定周期で位置データを出力する位置検
    出手段と、 前記一定周期より遅い周期で位置データを読み込んで位
    置制御を行うサーボ制御手段と、 前記位置検出手段が位置データを出力したときに計時を
    スタートし、前記制御手段による位置データの読み込み
    指令でタイマデータを出力するタイマ手段と、 前記タイマデータに基づいて前記位置検出手段の位置デ
    ータを補正し、補正された位置データを前記制御手段に
    出力する位置データ処理手段とから成ることを特徴とす
    る請求項1記載の位置制御装置。
  2. 【請求項2】 中央制御部に複数のサーボ制御ユニット
    部が接続され、各サーボ制御ユニット部についてサーボ
    アンプ部、サーボモータおよびエンコーダよりなる複数
    のサーボ制御系を有し、中央制御部よりの同期信号に基
    づいて位置制御する中央制御装置において、 前記複数のサーボ制御ユニット部がそれぞれ、前記タイ
    マ手段および位置データ処理手段を具備することを特徴
    とする位置制御装置。
JP00765695A 1995-01-20 1995-01-20 位置制御装置、位置制御システム Expired - Fee Related JP3434065B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP00765695A JP3434065B2 (ja) 1995-01-20 1995-01-20 位置制御装置、位置制御システム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP00765695A JP3434065B2 (ja) 1995-01-20 1995-01-20 位置制御装置、位置制御システム

Publications (2)

Publication Number Publication Date
JPH08194541A true JPH08194541A (ja) 1996-07-30
JP3434065B2 JP3434065B2 (ja) 2003-08-04

Family

ID=11671869

Family Applications (1)

Application Number Title Priority Date Filing Date
JP00765695A Expired - Fee Related JP3434065B2 (ja) 1995-01-20 1995-01-20 位置制御装置、位置制御システム

Country Status (1)

Country Link
JP (1) JP3434065B2 (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008142786A (ja) * 2006-12-06 2008-06-26 Nidec Sankyo Corp ロボットシスシステム及びロボット制御装置
JP2012183606A (ja) * 2011-03-04 2012-09-27 Seiko Epson Corp ロボット位置検出装置及びロボットシステム
WO2013008530A1 (ja) * 2011-07-11 2013-01-17 富士機械製造株式会社 トリガ発生装置
CN103605312A (zh) * 2013-10-12 2014-02-26 楚天科技股份有限公司 冻干机板层压塞油缸的伺服闭环控制系统
CN110622083A (zh) * 2018-04-25 2019-12-27 深圳市大疆创新科技有限公司 定位方法、装置、机器人、系统及存储介质

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0475111A (ja) * 1990-07-17 1992-03-10 Sankyo Seiki Mfg Co Ltd 指令信号発生方法
JPH05245639A (ja) * 1992-03-03 1993-09-24 Amada Co Ltd 溶接位置補正方法及び溶接位置補正装置
JPH0685859A (ja) * 1992-09-02 1994-03-25 Mitsubishi Electric Corp バースト復調装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0475111A (ja) * 1990-07-17 1992-03-10 Sankyo Seiki Mfg Co Ltd 指令信号発生方法
JPH05245639A (ja) * 1992-03-03 1993-09-24 Amada Co Ltd 溶接位置補正方法及び溶接位置補正装置
JPH0685859A (ja) * 1992-09-02 1994-03-25 Mitsubishi Electric Corp バースト復調装置

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008142786A (ja) * 2006-12-06 2008-06-26 Nidec Sankyo Corp ロボットシスシステム及びロボット制御装置
JP2012183606A (ja) * 2011-03-04 2012-09-27 Seiko Epson Corp ロボット位置検出装置及びロボットシステム
WO2013008530A1 (ja) * 2011-07-11 2013-01-17 富士機械製造株式会社 トリガ発生装置
JP2013020451A (ja) * 2011-07-11 2013-01-31 Fuji Mach Mfg Co Ltd トリガ発生装置
CN103605312A (zh) * 2013-10-12 2014-02-26 楚天科技股份有限公司 冻干机板层压塞油缸的伺服闭环控制系统
CN110622083A (zh) * 2018-04-25 2019-12-27 深圳市大疆创新科技有限公司 定位方法、装置、机器人、系统及存储介质

Also Published As

Publication number Publication date
JP3434065B2 (ja) 2003-08-04

Similar Documents

Publication Publication Date Title
EP1341311B1 (en) Signal processing apparatus for encoder
US10355717B2 (en) Encoder signal processing device, encoder, and signal processing method and recording medium
EP0265607B1 (en) Numerically controlled machine tool
US6806968B2 (en) Apparatus and method for measuring a workpiece
JPH08194541A (ja) 位置制御装置
EP1698957A1 (en) a PLL for synchronous operation of a distributed control system
JP3171770B2 (ja) Nc工作機械の移動位置誤差補正方法および移動位置誤差補正確認方法
US4095158A (en) Position-controlling system
JPH05245639A (ja) 溶接位置補正方法及び溶接位置補正装置
JP4638094B2 (ja) 複数軸制御装置及びその軸間同期方法
JP4498250B2 (ja) 同期制御システム
EP0753804A1 (en) Laser measuring apparatus
JPH05333931A (ja) ロボット制御装置
JP2007213154A (ja) モータの位置データを伝送し再生処理する方法およびその方法を実施する駆動制御システム
JPH11305812A (ja) 分散型cpuシステムの同期方法
JP2019101724A (ja) エンコーダ及び制御システム
JPH05337729A (ja) モーションコントローラ
JPH08202420A (ja) 数値制御装置の同期制御方式
JP2902005B2 (ja) 倣い軌跡のディジタイジング方法
JPH05150808A (ja) モーシヨンコントローラ
JP4059698B2 (ja) 慣性装置
JP2518923B2 (ja) 数値制御装置
CN121462902A (zh) 一种基于tdi线扫描相机的空间曲线触发信号发生系统
JP2622304B2 (ja) 交線加工用数値制御データの作成方法
JPH0687201B2 (ja) ロボツトの制御装置

Legal Events

Date Code Title Description
R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313111

R371 Transfer withdrawn

Free format text: JAPANESE INTERMEDIATE CODE: R371

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313115

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090530

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100530

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100530

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110530

Year of fee payment: 8

LAPS Cancellation because of no payment of annual fees