JP3988255B2 - 数値制御装置における位置指令方法および装置 - Google Patents

数値制御装置における位置指令方法および装置 Download PDF

Info

Publication number
JP3988255B2
JP3988255B2 JP15663398A JP15663398A JP3988255B2 JP 3988255 B2 JP3988255 B2 JP 3988255B2 JP 15663398 A JP15663398 A JP 15663398A JP 15663398 A JP15663398 A JP 15663398A JP 3988255 B2 JP3988255 B2 JP 3988255B2
Authority
JP
Japan
Prior art keywords
target position
actuator
command
time
cycle
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.)
Expired - Fee Related
Application number
JP15663398A
Other languages
English (en)
Other versions
JPH11327620A (ja
Inventor
具宏 上塩
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
Original Assignee
Yaskawa Electric Corp
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 filed Critical Yaskawa Electric Corp
Priority to JP15663398A priority Critical patent/JP3988255B2/ja
Publication of JPH11327620A publication Critical patent/JPH11327620A/ja
Application granted granted Critical
Publication of JP3988255B2 publication Critical patent/JP3988255B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Description

【0001】
【発明の属する技術分野】
本発明は、工作機械や自動組み立て装置、自動搬送装置などの制御に用いる数値制御装置に関する発明であり、さらに詳しくは、サーボアンプやサーボモータなどで駆動されるアクチュエータへの位置指令方法および装置に関する。
【0002】
【従来の技術】
従来、目標位置を作成する周期は、アクチュエータへの指令周期の整数倍となるように設定する必要があった。
整数倍に設定することにより、アクチュエータへの指令目標位置を、単純に次式(1)により求めることができた。
n =Qn-1 +(P m−P m-1)×Tq /T p ・・・(1)
ここで、
n :アクチュエータへの指令周期の時刻tn における、アクチュエータへの指令目標位置
n-1 :アクチュエータへの指令周期の時刻tn-1 における、アクチュエータへの指令目標位置
m :目標位置作成周期の時刻T mにおける、目標位置
m-1:目標位置作成周期の時刻T m-1における、目標位置
q :アクチュエータへの指令周期
p :目標作成周期
である。
【0003】
【発明が解決しようとする課題】
ところが、従来技術では、そもそも目標位置作成周期がアクチュエータへの指令周期の整数倍であるという前提に基づいたものであり、整数倍でない場合に適用できなかった。本発明は、目標位置作成周期がアクチュエータへの指令周期の整数倍でない場合にもアクチュエータへの指令目標位置を作成できる手段を提供することを目的とする。
【0004】
【課題を解決するための手段】
上記問題を解決するため、本発明は、次のように構成したのである。
請求項1に記載の発明は、目標位置作成周期とアクチュエータへの指令周期が異なる数値制御装置において、前記目標位置作成周期の積算値と前記アクチュエータの目標位置の増分値の積算値をもとに前記アクチュエータへの指令目標位置を求めることを特徴とするものである。
また、請求項2に記載の発明は、目標位置作成周期とアクチュエータへの指令周期が異なる数値制御装置において、前記目標位置作成周期の積算値と前記アクチュエータの目標位置の増分値の積算値をもとに前記アクチュエータへの指令目標位置を求める手段を備えたことを特徴とするものである。
本発明は、アクチュエータへの指令周期において、目標位置作成周期の積算値をたまり時間、目標位置の増分値の積算値をたまり移動量として管理し、このたまり時間とたまり移動量からアクチュエータへの指令目標位置を求める。
以下に、アクチュエータへの指令目標位置をもとめる原理を説明する。たまり時間とたまり移動量を管理するための状態として、出力待ち状態と出力状態があり、図2は、たまり時間とたまり移動量を管理するための状態遷移図である。ここで、出力状態とは、アクチュエータへの指令位置を更新する状態のことをいい、出力待ち状態から出力状態に状態遷移する条件としては、たまり時間≧Tq ×2が条件であり、逆に出力状態から出力待ち状態に状態遷移する条件は、たまり時間<Tq である。出力待ち状態でPn ≠Pn-1 の場合、次のようにたまり時間とたまり移動量およびアクチュエータへの指令目標位置を求める。
n =Qn-1 ・・・(2)
たまり時間=たまり時間+(Tn −Tn-1 ) ・・・(3)
たまり移動量=たまり移動量+(Pn −Pn-1 ) ・・・(4)
ここで、
n :アクチュエータへの指令周期の時刻tnにおける、アクチュエータへの指令目標位置
n-1 :アクチュエータへの指令周期の時刻tn-1 における、アクチュエータへの指令目標位置
n :アクチュエータへの指令周期の時刻tnにおいて参照できる、目標位置作成周期で作成された目標位置
n-1 :アクチュエータへの指令周期の時刻tn-1 において参照できる、目標位置作成周期で作成された目標位置
n :アクチュエータへの指令周期の時刻tnにおいて参照できる、目標位置作成周期での時刻
n-1 :アクチュエータへの指令周期の時刻tn-1 において参照できる、目標位置作成周期での時刻である。
同様に、出力待ち状態でPn =Pn-1 の場合は、次のように求める。
n =Qn-1 +たまり移動量 ・・・(5)
たまり時間=0 ・・・(6)
たまり移動量=0 ・・・(7)
同様に、出力状態でPn ≠Pn-1 の場合、次のように求める。
たまり時間=たまり時間+(Tn −Tn-1 ) ・・・(8)
たまり移動量=たまり移動量+(Pn −Pn-1 ) ・・・(9)
n =Qn-1 +たまり移動量×Tq/たまり時間 ・・・(10)
たまり時間=たまり時間−Tq ・・・(11)
たまり移動量=たまり移動量−(Qn −Qn-1 ) ・・・(12)
ここで、
q :アクチュエータへの指令周期である。同様に、出力状態でPn =Pn-1 の場合は、次のように求める。
n =Qn-1 +たまり移動量×Tq/たまり時間 ・・・(13)
たまり時間=たまり時間−Tq ・・・(14)
たまり移動量=たまり移動量−(Qn −Qn-1 ) ・・・(15)
【0005】
【発明の実施の形態】
以下、本発明の実施例を図に基づいて説明する。
図1は、本発明のアクチュエータへの指令目標位置を求めるためのブロック図である。図中1は目標位置作成周期で実行される目標位置作成処理部、2は目標位置作成処理部により作成された目標位置を格納するメモリ、3はアクチュエータへの指令周期で実行されるアクチュエータへの指令目標位置作成処理部、4はアクチュエータへの指令目標位置作成処理部のワークメモリ、5はアクチュエータへの指令目標位置作成処理部により作成されたアクチュエータへの指令目標位置を格納するメモリ、6はアクチュエータインターフェースである。
図3は、本発明の実施例における目標位置作成周期とアクチュエータへの指令周期の関係を示すタイミングチャートである。
図4は、目標位置作成周期=3ms、アクチュエータへの指令周期=2msとし、目標位置作成周期における目標位置の増分値=100とした場合の、たまり時間とたまり移動量およびアクチュエータへの指令目標位置の変化を示す表である。
目標位置作成処理部1が目標位置の作成を開始しても(時刻T0 )、初期状態は、図2における出力待ち状態であり、アクチュエータへの指令目標位置を更新しない状態である。
その後、たまり時間≧4msとなった時点(時刻t2 )で出力状態に状態遷移し、アクチュエータへの指令目標位置の更新を開始する。
時刻t2 およびt3 における指令位置の計算内容を図3、4を参照しながら以下に説明する。
(1)時刻t2 のとき
まず、時刻t2 において参照できる時刻と目標位置Pからたまり時間とたまり移動量を更新する。
Figure 0003988255
たまり移動量=時刻t1 でのたまり移動量+(時刻T1 での目標位置−時刻T0 での目標位置)=100+(200−100)=200
ここで、たまり時間(=6)≧Tq ×2(=4)なので、出力状態となり、時間Tq 分の出力(指令位置の増分値)を求める。
Figure 0003988255
出力を行なったので、その分たまり時間とたまり移動量を更新する。
たまり時間=6−Tq =6−2=4
たまり移動量=200−66=134
(3)時刻t3 のとき
まず、時刻t3 において参照できる時刻と目標位置Pからたまり時間とたまり移動量を更新する。
たまり時間=時刻t2 でのたまり時間+(時刻T2 −時刻T1
=4+(6−3)=7
たまり移動量=時刻t2 でのたまり移動量+(時刻T2 での目標位置−時刻T1 での目標位置)=134+(300−200)=234
ここで、たまり時間(=7)≧Tq ×2(=4)なので、出力状態となり、時間Tq 分の出力(指令位置の増分値)を求める。
Figure 0003988255
指令位置=時刻t2 での指令位置+指令位置の増分値=66+66=132
ここで出力を行なったので、その分たまり時間とたまり移動量を更新する。
たまり時間=7−Tq =7−2=5
たまり移動量=234−66=168
以下同様に、指令位置Qが求められる。
目標位置作成処理部1が目標位置の作成を終了すると(時刻T6 )、Pn =Pn-1 となるため、たまり移動量は減る一方となり、その後、たまり時間<2msとなった時点で図2における出力待ち状態に状態遷移する。
本実施例は目標位置作成周期>アクチュエータへの指令周期の場合について説明したが、目標位置作成周期<アクチュエータへの指令周期の場合についても同様である。
【0006】
【発明の効果】
以上述べたように、本発明によれば、目標位置作成周期がアクチュエータへの指令周期の整数倍でない場合でも、目標位置作成周期で作成された目標位置をアクチュエータへの指令周期におけるアクチュエータへの指令目標位置に変換することができる。
【図面の簡単な説明】
【図1】 本発明のアクチュエータへの指令目標位置を求めるためのブロック図である。
【図2】 たまり時間とたまり移動量を管理するための状態遷移図である。
【図3】 本発明の実施例における目標位置作成周期とアクチュエータへの指令周期の関係を示すタイミングチャートである。
【図4】 本発明の実施例におけるたまり時間とたまり移動量およびアクチュエータへの指令目標位置の変化を示す図である。
【図5】 本発明の実施例における目標位置周期での目標位置の変化を示すグラフである。
【図6】 本発明の実施例におけるアクチュエータへの指令周期での指令目標位置の変化を示すグラフである。
【符号の説明】
1・・・目標位置作成処理部
2・・・目標位置格納メモリ
3・・・アクチュエータへの指令目標位置作成処理部
4・・・ワークメモリ
5・・・指令目標位置格納メモリ
6・・・アクチュエータインターフェース。

Claims (2)

  1. 目標位置作成周期とアクチュエータへの指令周期が異なる数値制御装置において、
    前記目標位置作成周期の積算値と前記アクチュエータの目標位置の増分値の積算値をもとに前記アクチュエータへの指令目標位置を求めることを特徴とする数値制御装置における位置指令方法。
  2. 目標位置作成周期とアクチュエータへの指令周期が異なる数値制御装置において、
    前記目標位置作成周期の積算値と前記アクチュエータの目標位置の増分値の積算値をもとに前記アクチュエータへの指令目標位置を求める手段を備えたことを特徴とする数値制御装置。
JP15663398A 1998-05-20 1998-05-20 数値制御装置における位置指令方法および装置 Expired - Fee Related JP3988255B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP15663398A JP3988255B2 (ja) 1998-05-20 1998-05-20 数値制御装置における位置指令方法および装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP15663398A JP3988255B2 (ja) 1998-05-20 1998-05-20 数値制御装置における位置指令方法および装置

Publications (2)

Publication Number Publication Date
JPH11327620A JPH11327620A (ja) 1999-11-26
JP3988255B2 true JP3988255B2 (ja) 2007-10-10

Family

ID=15631949

Family Applications (1)

Application Number Title Priority Date Filing Date
JP15663398A Expired - Fee Related JP3988255B2 (ja) 1998-05-20 1998-05-20 数値制御装置における位置指令方法および装置

Country Status (1)

Country Link
JP (1) JP3988255B2 (ja)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6851620B2 (en) * 2003-04-30 2005-02-08 Invensys Building Systems, Inc. Floating actuator control system and method
JP5202271B2 (ja) * 2008-12-15 2013-06-05 三菱電機株式会社 スレーブ装置及びプログラム
JP5733518B2 (ja) * 2011-05-25 2015-06-10 株式会社Ihi 運動予測制御装置と方法
JP5679121B2 (ja) * 2011-05-25 2015-03-04 株式会社Ihi ロボットの運動予測制御方法と装置
CN103517789B (zh) 2011-05-12 2015-11-25 株式会社Ihi 运动预测控制装置和方法
JP5733516B2 (ja) * 2011-05-12 2015-06-10 株式会社Ihi 移動体把持装置と方法
JP5939505B2 (ja) * 2012-05-18 2016-06-22 株式会社Ihi ロボットハンド装置と制御方法

Also Published As

Publication number Publication date
JPH11327620A (ja) 1999-11-26

Similar Documents

Publication Publication Date Title
JP4813618B2 (ja) イナーシャと摩擦を同時に推定する機能を有する電動機の制御装置
JP3988255B2 (ja) 数値制御装置における位置指令方法および装置
JPH07110717A (ja) モータの制御方式
WO1991009358A1 (en) Servo motor control method
JP2006285301A (ja) ロボット制御装置およびロボットの位置決め精度補正方法
EP1471404A2 (en) Numerical control apparatus for machine tool
KR0160998B1 (ko) 로보트의 구동경로 계획방법
JPH0969013A (ja) サーボモータを用いたサーボ系の制御モード切り換え方法
Shiller et al. Trajectory preshaping for high-speed articulated systems
JP2003044102A (ja) 学習制御方法
JP2003169488A (ja) サーボモータの制御装置及び制御方法
JPH10105247A (ja) サーボモータのオーバーシュート防止方法
JPH09106304A (ja) 工作機械の作業領域制御方法
JP2703099B2 (ja) 産業用ロボットのコンベア追従方法
JP2002264054A (ja) 基板搬送ロボット制御方法
GB2273177A (en) Actuator position control.
JPS6344204A (ja) ロボツトのデイジタル制御装置
CN106325217A (zh) 具有学习存储器切换功能的伺服控制系统
JPH07265958A (ja) 折曲げ加工機用ロボットの制御方法
JP2653101B2 (ja) 位置決め制御用パルス発生器
CN115319274A (zh) Ifov系统的平台位置预测方法及振镜指令延时补偿
JP3773303B2 (ja) 部品供給部位置決め方法
KR830002245B1 (ko) 커터 이송 속도 제어방법
JP2004139253A (ja) 数値制御装置
JPH11191011A (ja) ロボット制御装置及びその制御方法

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20050418

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20070420

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20070424

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20070606

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20070626

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20070709

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

Free format text: PAYMENT UNTIL: 20100727

Year of fee payment: 3

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

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

Free format text: PAYMENT UNTIL: 20100727

Year of fee payment: 3

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

Free format text: PAYMENT UNTIL: 20110727

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20120727

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20130727

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20140727

Year of fee payment: 7

LAPS Cancellation because of no payment of annual fees