JPH01320501A - アクチュエータ制御方法 - Google Patents

アクチュエータ制御方法

Info

Publication number
JPH01320501A
JPH01320501A JP63155238A JP15523888A JPH01320501A JP H01320501 A JPH01320501 A JP H01320501A JP 63155238 A JP63155238 A JP 63155238A JP 15523888 A JP15523888 A JP 15523888A JP H01320501 A JPH01320501 A JP H01320501A
Authority
JP
Japan
Prior art keywords
data
speed command
motion
mode
unit time
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
JP63155238A
Other languages
English (en)
Inventor
Hiroyuki Inoue
博之 井上
Mikio Hasegawa
幹夫 長谷川
Takeshi Shiraishi
白石 健
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.)
Panasonic Holdings Corp
Original Assignee
Matsushita Electric Industrial 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 Matsushita Electric Industrial Co Ltd filed Critical Matsushita Electric Industrial Co Ltd
Priority to JP63155238A priority Critical patent/JPH01320501A/ja
Publication of JPH01320501A publication Critical patent/JPH01320501A/ja
Pending legal-status Critical Current

Links

Landscapes

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

Abstract

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

Description

【発明の詳細な説明】 産業上の利用分野 本発明は、産業用ロボットや位置決め装置の駆動部に用
いられるアクチュエータの制御方法に関するものである
従来の技術 近年工場の自動化にともない自動位置決め装置等が種々
使用されているが、それを実現して来たのがアクチュエ
ータ制御方法の進歩であった。
現在のアクチュエータの制御方法では、目標位置を記憶
しておいてその目標位置に対してアクチュエータに結合
された位置検出装置から取シ込んだ現在位置を比較し、
その差異に比例した速度指令をハードウェア構成された
駆動装置へ出力することで位置決めを行う方式をとって
おり上記の処理が制御装置内のROMにプログラム化さ
れているのが一般的である。また、駆動する負荷のイナ
ーシャが異なる場合、その負荷ごとにアクチュエータの
制御パラメータおよび駆動装置のゲイン設定を行ってい
るのが現状である。
発明が解決しようとする課題 しかしながら上記のような構成では、アクチュエータの
制御パラメータや駆動装置のゲイン調整を最適に行うた
めには動作中の位置、速度等の動作データを観測できる
特別な計測器が必要となり、多くの場合調整者の経験と
勘にたよらざるを得ないという問題点を有していた。
本発明は、上記問題点に鑑み、アクチュエータの動作制
御を行うと同時に、動作中の位置、速度等の動作データ
をサンプル及び記憶して、特別な計測器を使用すること
なく動作データ表示が行え調整作業が容易にできるアク
チュエータの制御方法を提供するものである。
課題を解決するための手段 上記問題点を解決するために請求項1のアクチュエータ
制御方法は、目標位置算出手段と現在位置数シ込み手段
と速度指令算出手段と速度指令出力手段とデータサンプ
ル手段とによる一連の動作制御処理の優先度を、動作デ
ータ算出手段と動作データ表示手段とによる一連の動作
表示処理よりも高く設定し前記単位時間ごとに実行させ
、前記単位時間のうち前記動作制御処理に使用されてい
ない時間を利用して前記動作表示処理を行うことを特徴
とするものである。
また請求項2のアクチュエータ制御方法は、現在位置取
り込み手段と、速度指令取り出し手段と、速度指令出力
手段と、データサンプル手段とによる一連のテスト動作
処理の優先度を、動作データ算出手段と、動作データ表
示手段とによる一連の動作表示処理よりも高く設定し前
記単位時間ごとに実行させ、前記単位時間のうち前記テ
スト動作処理に使用されていない時間を利用して前記動
作表示処理を行うことを特徴とするものである。
作  用 請求項1の発明は、上記した構成によって単位時間内の
動作制御処理に使用されない時間を利用してデータ表示
処理を行うので、特別な計測器を付加することなく動作
データの観測ができ、制御パラメータの調整が容易にで
きることとなる。
また請求項2の発明は、設定された速度指令パターンで
のテスト動作処理に使用されない時間を利用してデータ
表示処理を行うので、アク1ユエータの駆動装置のゲイ
ン調整が容易にできることとなる。
実施例 以下本発明の第1実施例のアクチュエータ制御方法につ
いて第1図〜第4図を参照しながら説明する。
第1図は、本実施例におけるアクチュエータ制御方法を
ソフトウェアで実現した場合の全体構成図である。第1
図において、1はタイミング信号出力手段、2は目標値
算出手段、3は現在位置取り込み手段、4は速度指令算
出手段、5はパラメータ設定手段、6は速度指令出力手
段、7はモード切り換え手段、8はデータサンプル手段
、9はデータ記憶手段、1oは動作データ算出手段、1
1は動作データ表示手段、12は動作制御処理、13は
動作表示処理、14は処理切り換え手段である。
最初に処理全体の説明を行う。
タイミング信号出力手段1から出力されるタイミング信
号はいわゆる割り込み信号であり、その単位時間Tごと
に優先度の高い動作制御処理12を実行し処理終了後戻
って来て動作表示処理13を続けるという形態をとり、
その処理切り換えを処理切り換え手段14が行う。
まず動作制御処理12の内容について説明を進める。動
作制御処理12は目標位置算出手段2、現在位置取り込
み手段3、速度指令算出手段4、速度指令出力手段6お
よびデータサンプル手段8で構成され、目標位置算出手
段2ではTごとに新しい目標位置を算出する。2点間を
移動する場合の目標位置0丁の算出法の一例を以下に説
明する。
移動開始位置θSから移動終了位置θEまでの間を加減
速度α、最高速W。a!の第2図で示されるような台形
速度で移動する場合、移動開始からnXT後の目標位置
θT(n)  は下式で表わされる。
(n=o、1,2・・・・・・) また停止中の目標位置θTはその値が保持される。
上式に従い単位時間Tごとの目標位置θTを算出する。
次に現在位置域シ込み手段3でアクチュエータ19に結
合された位置検出装置20より単位時間Tごとの現在位
置θCを取り込む。そして速度指令算出手段4で目標位
置0丁と現在位置θCの偏差に比例した速度指令vcを
算出する。比例定数をKと仮定すると、速度指令vcは
下式で表わされる。
V C=K X (θT−θC)    ・・・・・・
・・・・・・・・・(4)なお比例定数にはパラメータ
設定手段6で調整者が負荷イナーシャに対応して自由に
設定できるものとする。
速度指令出力手段6では、上記の速度指令VCをアナロ
グ値に変換して駆動装置21へ出力され、それによりア
クチュエータ19が駆動制御される。
モードがデータサンプルモードか否かはモード切り換え
手段7で調整者が設定でき、通常はデータサンプルモー
ドに設定されているものとする。
モードがデータサンプルモードの場合データサンプル手
段8でデータ記憶手段9に順次現在位置θC1目標位置
θTおよび速度指令vcデータを格納して行き、記憶容
量−杯になった所で格納を中止する。そしてアクチュエ
ータ19の移動開始とともにデータ記憶手段9の最初か
ら再度データの格納を開始する。そのためデータ記憶手
段9に格納されているデータは常に一番新しい移動時の
データであることになる。第3図に記憶容量3Xmの場
合のデータ記憶手段9の内容を示す。
次に動作表示処理13について説明する。動作表示処理
13は動作データ算出手段10および動作データ表示手
段11から構成され、モードが動作データ表示モードに
調整者が設定するまで待機状態になっている。
モードが動作データ表示モードになると動作データ算出
手段1oはデータ記憶手段9より各データを取り込み以
下の動作データを算出する。
(n=1 、2、−−−、 m 、 n<oでの値はn
=1の時の値を使用する) 最後に上記データを動作データ表示手段11で画面22
上に表示することで、特別なハードウェアを付加するこ
となく設定パラメータに対する動作を確認できることと
なる。第4図に動作データ表示例を示す。
次に本発明の第2実施例のアクチュエータ制御方法につ
いて第5図〜第7図を参照しながら説明する。
第5図において15は速度指令パターン記憶手段、16
は速度指令パターン設定手段、17は速度指令取り出し
手段、18はテスト動作処理である。
全体の処理形態は第1実施例と同様でちり、第1図の動
作制御処理12が第2図のテスト動作処理18に置き変
ったものと見なせるので同一符号を付して説明は省略し
、ここでは前記テスト動作処理18についてのみ説明す
る。
テスト動作処理18は現在位置取り込み手段3、速度指
令取り出し手段17、速度指令出力手段6およびデータ
サンプル手段8から構成される装置タサンプル手段8で
の処理内容は第1実施例と同様である。
本実施例の特徴は設定された速度指令パターンでアクチ
エエータ19を駆動することであり、その速度指令パタ
ーンは単位時間Tごとの速度指令データとして速度指令
パターン記憶手段16に複数パターン記憶されている。
速度指令パターンの例を第6図に示す。また第7図に1
つの速度指令パターンが1個のデータからなる場合の速
度指令パターン記憶手段16の内容を示す。
パターンの選択は調整者が行うことができ、そのパター
ンの速度指令パターン記憶手段16の中での先頭位置を
速度指令パターン設定手段16の処理の中で保持する。
そして速度指令取り出し手段1アでは、速度指令パター
ン設定手段1eの設定データをもとに速度指令パターン
記憶手段16より単位時間Tごとにデータを順次取り出
し、l個取り出すとまた最初にもどる。こうして取り出
された単位時間Tごとの速度指令を速度指令出力手段6
より出力し、アクチュエータ19を原動する。この時の
動作デ。
−夕を第1実施例同様画面22に表示することで、駆動
装置21のゲイン調整時の動作確認が容易に行える。
発明の効果 以上のように請求項1の発明は、動作時のアクチュエー
タの動作データを特別な計測器を付加することなく観測
でき制御パラメータの調整が容易にできるものである。
また請求項2の発明は、駆動装置のゲイン調整が容易に
なり、その実用的効果は大なるものがある。
【図面の簡単な説明】
第1図は本発明の第1発明の実施例における全体構成図
、第2図は台形速度指令時の時間−速度関係図、第3図
はデータ記憶手段の内容を表わす図、第4図は動作デー
タ表示画面図、第5図は本発明の第2実施例における全
体構成図、第6図は速度指令パターン図、第7図は速度
指令パターン記憶手段の内容を表わす図である。 1・・・・・・タイミング信号出力手段、2・山・・目
標値算出手段、3・・・・・・現在位置取り込み手段、
4・・・・・・速度指令出力手段、6・・・・・・パラ
メータ設定手段、6・・・・・・速度指令出力手段、7
・・・・・・モード切り換え手段、8・・・・・・デー
タサンプル手段、9・・・・・・データ記憶手段、10
・・・・・・動作データ算出手段、11・・・・・・動
作データ表示手段、12・・・・・・動作制御処理、1
3・・・・・・動作表示処理、16・・・・・・速度指
令パターン記憶手段、1e・・・・・・速度指令パター
ン設定手段、17・・・・・・速度指令取り出し手段、
18・・・・・・テスト動作処理、19・・・・・・ア
クチュエータ、20・・・・・・位置検出装置、21・
・・・・・駆動装置。 代理人の氏名 弁理士 中 尾 敏 男 ほか16第 
2 図 第3図 4乙’tJ&gt 3 X rn 第4図 五        就  ミ

Claims (2)

    【特許請求の範囲】
  1. (1)位置検出装置と、アクチュエータを駆動する駆動
    装置と、設定された単位時間ごとのタイミング信号を出
    力するタイミング信号出力手段と、位置決め動作時の前
    記単位時間ごとの目標位置を算出する目標位置算出手段
    と、前記位置検出装置より前記単位時間ごとの現在位置
    を取り込む現在位置取り込み手段と、前記単位時間ごと
    の目標位置と現在位置を一致させる速度指令を算出する
    速度指令算出手段と、前記速度指令算出時の制御パラメ
    ータを所望の値に変更できる制御パラメータ設定手段と
    、前記速度指令を前記駆動装置へ出力する速度指令出力
    手段と、前記目標位置および現在位置のサンプルを行う
    データサンプルモードか否かを切り換えるモード切り換
    え手段と、前記モード切り換え手段によるモードがデー
    タサンプルモードであると判定された場合前記目標位置
    および現在位置のサンプルを行うデータサンプル手段と
    、前記データサンプル手段でサンプルされたデータを記
    憶しておくデータ記憶手段と、前記モード切り換え手段
    によるモードがデータサンプルモードでない場合動作デ
    ータ表示モードであると判定し前記記憶領域に記憶され
    ているデータをもとに速度・加速度等の動作データの算
    出を行う動作データ算出手段と、前記動作データを画面
    等に表示する動作データ表示手段を備え、前記駆動装置
    に対する動作制御を単位時間ごとの速度指令により行う
    アクチュエータの制御方法において、前記目標位置算出
    手段と、前記現在位置取り込み手段と、前記速度指令算
    出手段と、前記速度指令出力手段と、前記データサンプ
    ル手段とによる一連の動作制御処理の優先度を、前記動
    作データ算出手段と、前記動作データ表示手段とによる
    一連の動作表示処理よりも高く設定し前記単位時間ごと
    に実行させ、前記単位時間のうち前記動作制御処理に使
    用されていない時間を利用して前記動作表示処理を行う
    ことを特徴としたアクチュエータ制御方法。
  2. (2)位置検出装置と、アクチュエータを駆動する駆動
    装置と設定された単位時間ごとのタイミング信号を出力
    するタイミング信号出力手段と、前記位置検出装置より
    前記単位時間ごとの現在位置を取り込む現在位置取り込
    み手段と、前記単位時間ごとの速度指令データからなる
    速度指令パターンを複数パターン記憶しておく速度指令
    パターン記憶出手と、使用する前記速度指令パターンを
    設定する速度指令パターン設定手段と、前記速度指令パ
    ターン設定手段で設定された速度指令パターンに対応す
    る前記速度指令パターン記憶手段に記憶されている速度
    指令データを前記単位時間ごとにとり出す速度指令取り
    出し手段と、前記速度指令を前記駆動装置へ出力する速
    度指令出力手段と、前記速度指令および現在位置のサン
    プルを行うデータサンプルモードか否かを切り換えるモ
    ード切り換え手段と、前記モード切り換え手段によるモ
    ードがデータサンプルモードであると判定された場合前
    記目標位置および現在位置のサンプルを行うデータサン
    プル手段と、前記データサンプル手段でサンプルされた
    データを記憶しておくデータ記憶手段と、前記モード切
    り換え手段によるモードがデータサンプルモードでない
    場合動作データ表示モードであると判定し前記記憶領域
    に記憶されているデータをもとに速度・加速度等の動作
    データの算出を行う動作データ算出手段と、前記動作デ
    ータを画面等に表示する動作データ表示手段を備え、前
    記駆動装置に対する動作制御を単位時間ごとの速度指令
    により行うアクチュエータの制御方法において、前記現
    在位置取り込み手段と、前記速度指令取り出し手段と、
    前記速度 指令出力手段と、前記データサンプル手段とによる一連
    のテスト動作処理の優先度を、前記動作データ算出手段
    と、前記動作データ表示手段とによる一連の動作表示処
    理よりも高く設定し前記単位時間ごとに実行させ、前記
    単位時間のうち前記テスト動作処理に使用されていない
    時間を利用して前記動作表示処理を行うことを特徴とし
    たアクチュエータ制御方法。
JP63155238A 1988-06-23 1988-06-23 アクチュエータ制御方法 Pending JPH01320501A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP63155238A JPH01320501A (ja) 1988-06-23 1988-06-23 アクチュエータ制御方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP63155238A JPH01320501A (ja) 1988-06-23 1988-06-23 アクチュエータ制御方法

Publications (1)

Publication Number Publication Date
JPH01320501A true JPH01320501A (ja) 1989-12-26

Family

ID=15601557

Family Applications (1)

Application Number Title Priority Date Filing Date
JP63155238A Pending JPH01320501A (ja) 1988-06-23 1988-06-23 アクチュエータ制御方法

Country Status (1)

Country Link
JP (1) JPH01320501A (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0454510A (ja) * 1990-06-21 1992-02-21 Mitsubishi Electric Corp サーボゲインの設定方法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5665208A (en) * 1979-11-02 1981-06-02 Toshiba Mach Co Ltd Load condition display unit
JPS59226906A (ja) * 1983-06-09 1984-12-20 Mitsubishi Electric Corp 速度制御方式
JPS6088319A (ja) * 1983-10-21 1985-05-18 Hitachi Ltd トレンド記録のグラフイツク表示方法
JPS6093518A (ja) * 1983-10-28 1985-05-25 Hitachi Ltd プラント運転履歴表示方式
JPS6155704A (ja) * 1984-08-27 1986-03-20 Fujitsu Ltd デイジタル制御装置
JPS6165304A (ja) * 1984-09-06 1986-04-03 Fujitsu Ltd デイジタル制御装置
JPS6174012A (ja) * 1984-09-19 1986-04-16 Toyoda Mach Works Ltd 位置決め制御装置
JPS61187616A (ja) * 1985-02-15 1986-08-21 Hitachi Ltd ビル管理用傾向表示装置
JPS61188604A (ja) * 1985-02-15 1986-08-22 Canon Inc 速度制御用関数発生装置

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5665208A (en) * 1979-11-02 1981-06-02 Toshiba Mach Co Ltd Load condition display unit
JPS59226906A (ja) * 1983-06-09 1984-12-20 Mitsubishi Electric Corp 速度制御方式
JPS6088319A (ja) * 1983-10-21 1985-05-18 Hitachi Ltd トレンド記録のグラフイツク表示方法
JPS6093518A (ja) * 1983-10-28 1985-05-25 Hitachi Ltd プラント運転履歴表示方式
JPS6155704A (ja) * 1984-08-27 1986-03-20 Fujitsu Ltd デイジタル制御装置
JPS6165304A (ja) * 1984-09-06 1986-04-03 Fujitsu Ltd デイジタル制御装置
JPS6174012A (ja) * 1984-09-19 1986-04-16 Toyoda Mach Works Ltd 位置決め制御装置
JPS61187616A (ja) * 1985-02-15 1986-08-21 Hitachi Ltd ビル管理用傾向表示装置
JPS61188604A (ja) * 1985-02-15 1986-08-22 Canon Inc 速度制御用関数発生装置

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0454510A (ja) * 1990-06-21 1992-02-21 Mitsubishi Electric Corp サーボゲインの設定方法

Similar Documents

Publication Publication Date Title
US4970448A (en) Method of and apparatus for ascertaining motion abilities of industrial robot
US20240001543A1 (en) Training device for indicating training point through direct training operation, robot control device, and computer program for training device
EP0389708A2 (en) Method of and apparatus for controlling velocity of industrial robot
US20090125139A1 (en) Numerical controller for storing operating history during path table operation
JPH02160487A (ja) ロボット手動送り補正方式
JP2005011203A (ja) 数値制御装置
JPH06190753A (ja) ロボット制御装置
JPH01320501A (ja) アクチュエータ制御方法
JPH09282020A (ja) サーボモータ駆動装置
JPH0561525A (ja) 移動体の動作表示装置及びその表示方法
JPH07160323A (ja) 産業用ロボットの動作波形診断装置
JPH06138950A (ja) フィードバック制御方式のロボット制御装置
EP1796263A1 (en) Time constant automatic estimation method, time constant automatic estimation apparatus and servo motor control system
GB2273177A (en) Actuator position control.
JPH081564A (ja) ロボット制御装置
WO1991013388A1 (en) Improvements in or relating to actuator control
JPH10139369A (ja) 吊荷の振れ止め制御装置
JP2001339994A (ja) ステッピングモータの制御方法、制御システム及びモータ駆動制御装置
JPH10111708A (ja) 位置決め制御装置
JPH01261710A (ja) ロボット制御装置
JPH1015864A (ja) 手動パルス発生装置
JPH08137530A (ja) 数値制御装置
JP2540594B2 (ja) 速度制御方法
JPH05307406A (ja) ロボットの制御装置
JPH10138059A (ja) 自動組立装置及びその制御方法