JP4407083B2

JP4407083B2 - Command value generation method and command value generation system

Info

Publication number: JP4407083B2
Application number: JP2001200744A
Authority: JP
Inventors: 智典佐藤
Original assignee: Mitsubishi Electric Corp
Current assignee: Mitsubishi Electric Corp
Priority date: 2001-07-02
Filing date: 2001-07-02
Publication date: 2010-02-03
Anticipated expiration: 2021-07-02
Also published as: JP2003015715A

Description

【０００１】
【発明の属する技術分野】
この発明は、半導体製造装置など各種製造装置、エレベータ、エスカレータ、ミシン、座標測定器、プロッタ、搬送装置、自動車・列車・航空機などの輸送機器、或いは玩具など複数の軸を備えた駆動系およびそれらの制御装置の指令値生成方法、およびそれらの指令値生成システムに関するもので、特に、数値制御装置いわゆるＮＣ装置やロボットコントローラなどの指令値生成システムからの指令によって動作する加工機、ロボット、成形機など複数軸の動作の総合により目的とする動作を行う駆動系に対する指令値を生成する指令値生成方法および指令値生成システムに関するものである。
【０００２】
【従来の技術】
数値制御装置いわゆるＮＣ装置やロボットコントローラなどの駆動対象に対する指令値を生成する指令値生成システムでは、上記指令値生成システムに指令するプログラムを作成するＣＡＤ／ＣＡＭなどのプログラム作成装置によってプログラム指令された指令経路と指令速度に基づいて、ロボットや加工機などの駆動対象が保有する複数の各軸に対して各軸を動作させるための指令値を与えることにより、上記各軸に対応する各可動部を同時に動作させ、各可動部の動作の総合によって目的の作業を行わせる。このとき、プログラム指令された送り速度に対し、上記指令値生成システムにおいて、各可動部の加減速を行うための指令値を生成して各可動部に自動的に加減速をかけることで、滑らかな動作を実現させるのが一般的である。
図１６は、従来の指令値生成方法における流れ図を示したものである。図１６において、Ｆは指令速度、Ｐは指令経路、ｔは時間、Ｖは速度、ＸおよびＹは座標軸である。
従来の方法は、図１６に示したように、プログラムから各サーボ軸への指令値を生成する手順は、「前処理」、「加減速」、「補間」および「座標変換」というように行われる。すなわちプログラミング等を行うＣＡＤ／ＣＡＭなどのプログラム作成装置で指令速度と指令経路がプログラム指令され、上記指令速度と指令経路はＮＣ装置などの数値制御システムに読込まれ、例えばプログラム座標系上の数値である指令速度Ｆ４０や、指令経路Ｐ１からＰ２までの曲線に沿った長さ等を計算するなどの前処理がなされる。次いで、上記指令経路に沿った方向に速度を滑らかにする加減速が行われ、加減速された後の加減速後速度Ｖｋに基づいて、現在の位置Ｐｋから単位時間当たりの移動量、すなわち加減速後速度Ｖｋと補間周期ｄｔの積に相当する分だけ進んだ位置Ｐｋ＋１を計算して各軸の座標値を求める補間が行われる。さらに、プログラム座標系上の座標値から、機械構造に応じて座標値を駆動対象の有する各軸の単位移動量を要素とする座標系、すなわち機械座標系上の座標値に変換されることにより、各サーボ軸への滑らかな指令値が作成される。上述の従来法における加減速は、一般に補間前加減速と呼ばれるもので、加減速による遅れに起因する軌跡誤差が発生しない長所をもつが、各軸の加速度が所定の許容加速度を越えないように制御しなければならないという制限があった。
【０００３】
図１７は、特開平０３-０７８００６号公報に掲載された従来の指令値生成方法を示すＮＣ装置などの指令値生成システムにおける指令値生成部の構成図である。図１７において、８００は指令値生成部全体、８１はプログラム指令された指令要素に対して指令の解釈や補正などの前処理を行う前処理部、８２は上記前処理部８１で前処理された指令要素を格納するバッファ、８３、８４はそれぞれ上記バッファ８２に格納された指令要素中の指令経路および指令速度、８５は上記指令経路８３および各軸の許容加速度から移動方向の許容加速度を求める加速度計算部、８６は上記加速度計算部８５で求められた移動方向の許容加速度および上記指令経路８３と指令速度８４に基づいて加減速を行う加減速部、８７は上記加減速部８６において加減速された結果である加減速後速度と上記指令経路８３から補間を行い、各サーボ制御部に対応する実軸座標系上の指令位置を求める補間部である。
また、Ａは上記加速度計算部８５で求められた可動部が移動する移動方向の許容加速度、Ａ１〜Ａｎは複数軸からなる可動部分の各軸の許容加速度、Ｂはプログラム指令された指令要素、Ｂｄは上記前処理部８１で前処理された後の指令要素、ＳＶ１〜ＳＶｎは各サーボ制御部に対応する各軸、Ｖａは上記加減速部８６で加減速された結果である加減速後速度を示す。
【０００４】
次に、動作について説明する。
図１７に示すように、プログラム作成部で作成された指令要素Ｂは、指令値生成部８００の中で、先ず、指令値生成部内の前処理部８１において指令の解釈や補正などの前処理が行われ、前処理された指令要素Ｂｄとしてバッファ８２に格納される。バッファ８２に格納された上記指令要素Ｂｄの構成要素である指令経路８３と指令速度８４は、指令値生成部の加速度計算部８５において各軸の許容加速度Ａ１〜Ａｎから移動方向の許容加速度Ａが求められた後、加減速部８６において上記移動方向の許容加速度Ａおよび上記指令要素Ｂｄの指令経路８３と指令速度８４に基づいて加減速が行われる。次いで加減速された結果である上記加減速後速度Ｖａとバッファ８２に格納された指令要素Ｂｄの指令経路８３とから補間部８７にて補間が行われる。指令要素Ｂｄはこのようにして補間部８７において補間された後、最終的に各サーボ制御部に対応する各軸ＳＶ１〜ＳＶｎの実軸座標系上の位置指令が求められる。ここで特徴的な点は、加速度計算部８５がバッファ８２に格納された指令要素の指令経路で決まる移動方向許容加速度を各軸の許容加速度Ａ１〜Ａｎに応じて求める点であり、これにより移動方向や向きによって加速度を切換えることができる。
【０００５】
上述したように、従来の指令値生成法における加減速処理は、プログラムする指令要素毎、或いは一定周期毎に加速度を切換える必要があり、そのため複雑な計算を頻繁に行わなければならず、それゆえ加減速処理に要する計算量が多くなって、加工時間が増大したり、加減速時に速度パターンが乱れるなどの問題があった。特に、先読みを用いて複数ブロックにまたがる加減速処理をする場合、計算量が極めて多くなり、実用上適さないという問題があった。また、指令経路と指令速度をプログラム指令する際に基準として用いるプログラム座標系は、一般に作業対象に対する作業工具の座標値を表す作業座標系と異なっており、上記プログラム座標系と作業座標系が一致していない場合、従来技術では、例えば、軌跡制御、力制御、外乱補償、各種誤差補正などの高度な制御を行うことが困難であった。このように従来技術では、指令値生成方法などに起因して加工時間が短く、加減速時の速度パターンの乱れなどが少ない、スムースで、かつ高性能な駆動を容易に実現することが難しかった。
【０００６】
この発明は、上記のような従来の指令値生成方法や指令値生成システムおよびプログラム作成装置がもつ問題点を解決するためになされたものであり、容易に短時間で効率よく加減速処理が行える指令値生成方法および遅れやずれのない高性能かつスムースな駆動が実現できる指令値生成システムおよびプログラム作成装置を提供するものである。
【０００７】
【課題を解決するための手段】
この発明に係る第一の構成による指令値生成方法は、複数軸を備え、それら複数軸の各軸に対応する可動部を動作させ、その動作の総合により目的とする作業を行う駆動対象の加減速を行うための指令値を生成する指令値生成方法において、上記駆動対象が備える各軸の単位移動量を要素とする第一の座標系、プログラム指令する際に基準として用いる第二の座標系、および上記第一の座標系を上記駆動対象が備える各軸の許容加速度で正規化した第三の座標系をそれぞれ設け、プログラム指令する指令経路と指令速度の少なくともいずれか一方は、加減速を行うための上記第三の座標系上の指令値に変換し、上記座標変換した指令値と上記第三の座標系上の加減速パラメータとに基づいて上記駆動対象の加減速を行うようにしたものである。
【００１０】
この発明に係る第二の構成による指令値生成方法は、第三の座標系は、作業対象に対する作業工具を表す座標系としたものである。
【００１２】
この発明に係る第三の構成による指令値生成方法は、駆動対象が有する各軸の加減速動作を補間する補間は、第一乃至第三の座標系のいずれかを用いて行うようにしたものである。
【００１３】
この発明に係る第四の構成による指令値生成システムは、複数軸を備え、それら複数軸の各軸に対応する可動部を動作させ、その動作の総合により目的とする作業を行う駆動対象の加減速を行うための指令値を生成する指令値生成システムにおいて、上記駆動対象が備える各軸の単位移動量を要素とする第一の座標系、プログラム指令する際に基準として用いる第二の座標系、および上記第一の座標系を上記駆動対象が備える各軸の許容加速度で正規化した第三の座標系を備え、プログラム指令する指令経路と指令速度の少なくともいずれか一方は、加減速を行うための上記第三の座標系上の指令値に変換し、上記座標変換した指令値と上記第三の座標系上の加減速パラメータとに基づいて上記駆動対象の加減速を行うものである。
【００１５】
【発明の実施の形態】
実施の形態１．
図１に本発明によるＮＣ装置などの指令値生成システムにおける指令値生成部の構成図を示す。図１において、１００は本発明の指令値生成部であり、１はプログラム指令された指令要素に対して指令の解釈や補正などの前処理を行う前処理部、２は上記前処理部１で前処理された指令要素Ｂを格納するバッファ、３は上記バッファ２に格納された指令要素の指令経路Ｐｍおよび指令速度Ｆｍを各々指令経路Ｐａおよび指令速度Ｆａに変換する座標変換部、４は上記座標変換部３において座標変換された指令経路Ｐａと指令速度Ｆａおよび加速度Ａｃに基づいて加減速を行う加減速部、５は上記加減速部４において加減速された結果である加減速後速度Ｖａと上記座標変換部３において座標変換された指令経路Ｐａとから補間処理を行う補間部、６は上記補間部５で補間された位置指令Ｑａを各サーボ制御部各軸に対応する機械座標系上の位置指令Ｑｍに変換する座標逆変換部である。
【００１６】
図２は本発明による指令値生成方法の流れ図を示したものである。図２において、Ｆは指令速度、Ｐは指令経路、ｔは時間、Ｖは速度、ＸおよびＹは座標軸である。
本発明による指令値生成方法の流れは、図２に示したように、指令速度と指令経路がプログラム指令されると、従来法と同様に先ず前処理が行われ、前処理された指令速度と指令経路は加減速前に、加減速を行うための指令値を表す第三座標系へ座標変換され、その後、加減速される。次いで、加減速後速度Ｖｋに基づいて、現在の位置Ｐｋから単位時間当たりの移動量、すなわち加減速後速度Ｖｋと補間周期ｄｔの積に相当する分だけ進んだ位置Ｐｋ＋１を計算して各軸の座標値を求める補間が行われ、再び、プログラム座標系に座標変換され、さらに、プログラム座標系上の座標値から、機械構造に応じて機械座標系上の座標値に変換されることにより、各サーボ軸への滑らかな指令値が作成される。
【００１７】
次に、図１に示した指令値生成部の動作について説明する。
まず、プログラム指令された指令要素Ｂは、指令値生成部１００の前処理部１において、プログラム指令を行うための指令値を表す座標系によって指令された指令速度Ｆｍと指令経路Ｐｍが読み込まれ、指令速度や長さ等が計算されて前処理され、上記前処理後に指令要素Ｂｄとしてバッファ２に格納される。上記バッファ２に格納された上記指令要素Ｂｄの指令速度Ｆｍと指令経路Ｐｍは、座標変換部３において上記プログラム指令を行うための指令値を表す座標系とは異なる加減速を行うための指令値を表す第三の座標系である加減速座標系によって指令経路Ｐａ、指令速度Ｆａに数値変換される。次いで、加減速部４において、加減速を行うための指令値を表す上記加減速座標系によって数値変換された指令経路Ｐａと指令速度Ｆａおよび加速度Ａｃに基づいて、経路に沿った方向に速度を滑らかにする加減速処理が行われる。その後、補間部５において、上記加減速処理された加減速後速度Ｖａと上記指令経路Ｐａに基づいて現在位置から単位時間あたりの移動量、すなわち加減速後の速度と補間周期ｄｔの積の分だけ進んだ位置Ｐｋ＋１を計算して各軸の座標値を求める補間処理が行われる。さらに、座標逆変換部６において、上記補間処理された各軸の座標値すなわち加減速座標系上の指令位置Ｑａは、上記加減速座標系上の数値から各サーボ軸ＳＶ１〜ＳＶｎに応じた機械座標系上の数値、すなわち滑らかな位置指令Ｑｍに変換される。
【００１８】
ところで、本発明において、加減速部４で加減速を行うための指令値を表す座標系としては、駆動対象の備える各軸の単位移動量を要素とする第一の座標系およびプログラムを行うための指令値を表す第二の座標系とは異なる、加減速を行うための指令値を表す第三の座標系を用いるものである。上記加減速を行うための指令値を表す第三の座標系は、上記第一の座標系および上記第二の座標系に対して、例えば、少なくともひとつの座標軸の最小単位量が異なる、或いは座標軸の方向が異なる、或いは座標軸の原点が異なる、或いは座標系の備える軸数が異なる、或いは直交座標系、斜交座標系、極座標系、円筒座標系などのように座標系の種類が異なるように設け、この第三の座標系を用いて、上記第三の座標系の各軸、或いは合成方向の速度、加速度、加加速度、時定数、精度などの加減速パラメータを指定し、それらのパラメータに基づいて第三の座標系上で加減速処理を行うものである。
【００１９】
第三の座標系として、プログラム座標系を軸毎の許容加速度で正規化した座標系を用いる場合を図３に示す。
図３において、Ａｘ，ＡｙはそれぞれＸ軸方向、Ｙ軸方向の許容加速度、Ｆは指令速度、Ｇ９０は絶対座標値モード、Ｇ１は直線補間、Ｎはブロック、Ｐは座標位置、Ｕは加減速を行うための指令値を表す座標系上の単位移動量、ＸはＸ軸座標値、ＹはＹ軸座標値である。また、図３（ｉ）はプログラム、図３（ｉｉ）はプログラム座標系、図３（ｉｉｉ）は加減速を行うための指令値を表す加減速座標系である。
【００２０】
図３(ｉ)のプログラム指令値は、図３（ｉｉ）に示すように、プログラム座標系上の座標値Ｘｐ、Ｙｐで与えられ、指令速度Ｆは４０で、ブロックＮ１で位置Ｐ１すなわちＸｐ＝４，Ｙｐ＝０まで直線補間で移動し、次にブロックＮ２で位置Ｐ２すなわちＸｐ＝４、Ｙｐ＝４まで直線補間で移動するようにプログラム指令されている。例えば、プログラム座標系上のＸ軸方向の許容加速度Ａｘを１、Y軸方向の許容加速度Ａｙを２とする。このとき加減速を行うための指令値を表す第三の座標系を、原点および座標系のＸ軸、Ｙ軸ともにプログラム座標系と同一方向で、各軸方向の単位移動量Ａｘ，Ａｙを各々１、２とし、図３（ｉｉｉ）のように設定する。
【００２１】
次に、プログラム座標系を軸毎の許容加速度で正規化した座標系を用いて計算した例を図４に示す。
図４において、Ａｘ，ＡｙはそれぞれＸ軸方向の許容加速度、およびＹ軸方向の許容加速度、φは座標変換行列である。また、図４（ｉ）はプログラム、図４（ｉｉ）は加減速を行うための指令値を表す加減速座標系を示す。
【００２２】
プログラム指令を行うための指令値を表す座標上の座標値が各々Ｘｐ、Yｐで表される場合、加減速を行うための指令値を表す第三の座標系上の座標値ＸａおよびＹａは、上記図４（ｉ）に示したような式で与えられる。例えば、加減速を行うための指令値を表す加減速座標系における点Ｏｐの座標値Ｘａ、Ｙａがそれぞれ０、０、点Ｐ１の座標値Ｘａ、Ｙａがそれぞれ４、０、点Ｐ２の座標値Ｘａ，Ｙａがそれぞれ４、２となる。このとき加減速を行うための指令値を表す第三の座標系である加減速座標系においてブロックＮ１の移動量はΔＸａ＝４、ΔＹａ＝０で長さが４、ブロックＮ２の移動量は ΔＸａ＝０、ΔＹａ＝２で長さが２となっている。さらに移動速度が長さに比例するように速度計算すると、ブロックＮ１の移動速度は、４０×４／４＝４０、ブロックＮ２の移動速度は、４０×２／４＝２０となり図４（ｉｉ）に示したようになる。
【００２３】
図５は本発明による指令値生成方法を実施した場合の速度パターンを従来のものと比較して示したものである。同一番号、同一符号は同じものを表す。
図５において、（ｉ）は従来の速度パターン、（ｉｉ）、（ｉｉｉ）はそれぞれ本発明の速度パターンであり、横軸は時間、縦軸は合成速度である。
【００２４】
従来の指令値生成法では、プログラム指令を行うための指令値を表す座標系上で一定の加速度、すなわちＸｐ軸とＹｐ軸のなかで一番低い加速度、すなわちＡ＝１を用いて加減速を行うため図５（ｉ）に示したような速度パターンとなる。
一方、本発明によれば、加減速を行うための指令値を表す第三の座標系は各軸の許容加速度で正規化されており軸毎の特性（許容加速度）はすべて等しく、すべて１になる。加減速部においては、この軸ごとの特性がすべて等しい加減速座標系上を、前述の図４（ｉｉ）の指令系経路と指令速度に対して、一定の加速度で加減速を行い、その結果として図５（ｉｉ）に示すような速度パターンが得られる。この速度パターンに基づいて補間を行い、補間された座標値に座標変換行列φを乗じて、再びプログラム指令を行うための指令値を表す座標系上の数値に変換する。すなわち、加減速を行うための指令値を表す第三の座標系である加減速座標系上の位置指令Ｑａと機械座標系上の位置指令Ｑｍとの関係式Ｑｍ＝φ×Ｑａによって数値変換される。上記の関係式を二回微分すると、機械座標系上の加速度Ａは、φと加減速を行うための指令値を表す第三の座標系上の加速度（最大１）との積となり、各軸の許容加速度を超えないようになっていることがわかる。このときのプログラム座標系上の合成速度は、図５（ｉｉｉ）に示したような速度パターンとなり、結果的にプログラム座標系上におけるブロックＮ２の移動では加速度Ａ＝２で加減速されるため、従来に比べ加工時間が短縮できる。
【００２５】
このように本発明では加減速処理を行うための指令値を表す第三の座標系自身を許容加速度で正規化したことにより、加減速処理としては一定の加速度を使用でき、そのため過渡的に速度パターンが乱れることなく、かつ簡単な加減速処理で容易に各軸の許容加速度に応じた各サーボ制御部への指令が得られるため、移動方向等に応じて加速度を切り替えるのと同等の時間で移動を終えることが可能となる。
【００２６】
また、上記以外にも、加減速を行うための指令値を表す第三の座標系として、作業対象に対する作業工具を表す作業座標系を用いることで作業目的に合致した制御を実現することができる。例えば２軸からなる関節型ロボット、一対の２軸が平行でもう一対の２軸が平行な機械、２軸が互いに直交していない機械、或いは直線軸と回転軸を組合わせた機械などにおいて、プログラムに機械の備える各軸の座標値を指令する場合、それぞれ作業対象に対する作業工具を表す座標系は被加工物を基準とした直交座標系とし、この座標系をもって加減速を行うための指令値を表す第三の座標系として上記座標系上の工具先端に対応する座標値に注目して加減速を行う。
【００２７】
図６に第三の座標系として、作業工具を表す作業座標系を用いる場合の実施例を示す。
図６において、Ｘａ、Ｙａは各々第三の座標系である加減速座標系上のＸ軸、Ｙ軸、Ｘｐ、Ｙｐはプログラム座標系上のＸ軸、Ｙ軸、Ｘｗ、Ｙｗは作業座標系上のＸ軸、Ｙ軸であり、θは被加工物とプログラム座標系上のＸ軸との傾き角である。同一番号、同一符号は同一のものを表す。また、図６（ｉ）はプログラム座標系上の作業座標系、図６（ｉｉ）は加減速座標系、図６（ｉｉｉ）は加減速座標系上の速度、長さを示す図である。
【００２８】
先ずプログラム座標系のＸ軸は、紙面の左右方向、Ｙ軸は上下方向に設けられているとし、プログラム座標系に対して被加工物がθ＝４５°回転した位置に置かれているとする。また、被加工物の加工面を加工するために加工面に平行な方向の動作として、指令速度Ｆ＝４０で、ブロックＮ１でＸｐ＝３、Ｙｐ＝３まで直線補間で移動し、ブロックＮ２でＸｐ＝１、Ｙｐ＝５まで移動するようにプログラム指令されているとする。このときの作業座標系とプログラム座標系との関係は図６（ｉ）のようになり、さらに上記作業座標系を第三の座標系、すなわち加減速座標系として用いた場合、プログラム座標系と加減速座標系の関係は図６（ｉｉ）のようになる。加減速座標系の原点は（０、０）、Ｘａ軸は４５°方向で単位長さＵｘａは√２／２、Ｙａ軸は１３５°方向で単位長さＵｙａは√２となる。また、プログラム座標系と加減速座標系との関係式から、加減速座標系上の座標値、長さ、および長さに比例するように移動速度を求めるとそれぞれ図６（ｉｉｉ）に示したように、Ｎ１の移動長さ６、移動速度５７、Ｎ２の移動長さ２、移動速度２８になる。
【００２９】
図７に、本発明の指令値生成方法を実施した場合の速度パターンを従来法場合と比較して示す。
図７において、Ａは加速度であり、同一符号は同一のものを表す。図７（ｉ）は従来法の速度パターン、図７（ｉｉ）は本発明の加減速座標系上の速度パターン、図７（ｉｉｉ）は本発明の指令値生成方法を実施した場合のプログラム座標系上の速度パターンを示す。
【００３０】
従来技術では、プログラム座標上で一定の加速度、すなわちＸｐ軸とＹｐ軸のなかで最小の加速度である√２／２を用いて加減速を行う。そのため図７（ｉ）に示したような速度パターンとなる。
本発明の指令値生成方法によれば、加減速座標系は各軸の許容加速度で正規化されているので加減速座標系上ではどの軸についても加速度は１である。そのため前述の図６（ｉｉｉ）に示した指令経路と指令速度に対して、一定の加速度１で加減速を行い、その結果として図７（ｉｉ）のような速度パターンとなる。上記速度パターンに基づいて補間を行い、再びプログラム座標系上の座標値に変換すると、プログラム座標系上の合成速度は図７（ｉｉｉ）に示したような速度パターンとなる。その結果、本発明の方法によればＮ２の移動ではプログラム座標系上の加速度Ａ＝√２で加減速され、従来法に比べて加工時間が短縮される。
【００３１】
図８は軸毎の許容加速度に基づいて移動方向に応じて加速度を変更する場合の実施例を示したものである。
図８において、Ａは加速度、Ｆは速度、Ｎはブロック、Ｐは指令経路、Ｕは単位長さを示す。また、図８（ｉ）はプログラム座標系、図８（ｉｉ）は加減速座標系を示す。
【００３２】
図８（ｉ）のように、プログラム座標系上の指令速度Ｆ＝４０、ブロックＮ１でＸｐ＝４、Ｙｐ＝３まで直線補間で移動するように指令されているとする。プログラム座標系上のＸ軸およびＹ軸の許容加速度ＡｘおよびＡｙがそれぞれ１、２とする。加減速座標系とプログラム座標系との関係から図８（ｉｉ）に示すように、加減速座標系上の座標値ＸａおよびＹａはそれぞれ４、１．５、速度Ｆ＝３４、移動方向の加速度Ａｃ′は１．２５となる。このように、本発明の方法では、従来法のように方向によらず一定加速度１を用いた場合よりも、加速度を大きくとれるため、加工時間が短縮できる。
【００３３】
図９に加減速座標系として軸方向だけを変え、加減速座標系上の許容加速度を軸毎に異なるようにした場合の実施例を示す。
図９において、Ａｃ′は移動方向の加速度、Ａａｘ、Ａａｙは加減速座標系上の許容加速度、Ａｊｘ、Ａｊｙはプログラム座標系上の許容加速度である。同一番号、同一符号は同一のものを表す。また、図９（ｉ）はプログラム座標系、図９（ｉｉ）は加減速座標系、図９（ｉｉｉ）はプログラム座標系と加減速座標系の関係を示したものである。
【００３４】
図９（ｉ）のように、プログラム座標系上の指令速度Ｆ＝４０、ブロックＮ１でＸｐ＝０、Ｙｐ＝４まで直線補間で移動するように指令されているとする。また、図９（ｉｉ）に示すように、加減速座標系上のＸａ軸、Ｙａ軸は、それぞれ４５°方向、１３５°方向傾き、単位長さは、それぞれ１、１とし、許容加速度Ａａｘ、Ａａｙをそれぞれ√２／２、√２に設定する。図９（ｉｉｉ）のように、プログラム座標系と加減速座標系の関係から移動方向の加速度Ａｃ′は各軸の加速度が許容加速度に到達する加速度のうち最小の値、Ａｃ′＝１となり、設定値がプログラム座標系上の最小の許容加速度に制限される従来法に比べて高い値となる。このようにプログラム座標系や機械座標系とは異なる方向に許容加速度の異方性がある場合には、本発明の指令値生成方法によれば短時間で移動が完了できる効果がある。
【００３５】
なお、加減速を行うための指令値を生成する座標系としては、上述の各軸の許容加速度で正規化する以外に、各軸の許容速度、許容負荷トルク、減速比、許容振動レベル、許容誤差などで正規化してもよい。さらに、許容加速度を含めてこれらのうち少なくともひとつ以上を所定の関数式で総合した値によって正規化したものを用いてもよく、その場合には、複数の指標を同時に考慮することも可能となる。
【００３６】
また、ここでは一定の加速度で加減速を行う場合について述べたが、そのほかにも、時定数一定型の移動平均フィルタを用いる、或いは一次／二次／ｎ次遅れ型加減速を用いる、或いは一定の加速度で加減速を行う場合を含めてこれらの組み合わせを用いてもよく、特に、移動時間の短さと加減速動作の滑らかさを両立するためには、一定の加速度で加減速を行った後に、移動平均フィルタなどの後置フィルタ（Ｓ字フィルタ）を設けると非常に効果的である。そのほかの加減速を行うための指令値を表す第三の座標系としては、機械座標系を回転させた座標系、任意の一次変換行列を乗じて変換した座標系、および非線形な変換を含めて任意の変換を行った座標系を用いてもよい。
【００３７】
上述の例では、サーボ制御部が位置指令を受け取ることを想定し、指令値生成部からサーボ制御部に位置指令を送信するように構成したが、サーボ制御部がそれ以外のデータ、例えば速度指令や加速度指令を受け取る場合には、指令値生成部は位置指令から例えば１回ないしは２回微分をとることで速度指令ないしは加速度指令を作成し、サーボ制御部に送信すればよい。
【００３８】
実施の形態２．
ここでは、円弧やスプライン曲線、ＮＵＲＢＳ曲線など指令要素中においても時々刻々移動方向が異なり、指令要素中においても時々刻々と加減速のための座標系を切り替える場合について説明する。
図１０は本発明の実施の形態２における指令値生成システムの指令値生成部の構成を示すブロック図である。
図１０において、２００は指令値生成部、７はバッファ２に格納された指令経路Ｐｍを分割してセグメントを作成するセグメント作成部を示す。また、Ｐｍ１はセグメント毎の指令経路、Ｆｍ１はセグメント毎の指令速度、Ｐａ１は上記セグメント毎の指令経路Ｐｍ１を、第三の座標系である加減速を行うための指令値を表す加減速座標系上の値に座標変換した指令経路、Ｆａ１は上記セグメント毎の指令速度Ｆｍ１を、第三の加減速を行うための指令値を表す加減速座標系上の値に座標変換した指令速度を示す。なお、同一番号および同一符号は上述の場合と同一のものを示す。
【００３９】
次いで動作について説明する。
動作は、上記指令値生成部２００内の上記セグメント作成部７において、前処理されバッファに格納された指令要素Ｂｄを分割してセグメント化した指令経路Ｐｍ１、指令速度Ｆｍ１が作成される。次いで、上記指令経路Ｐｍ１、指令速度Ｆｍ１が座標変換部３において、加減速を行うための指令値を表す第三の座標系上の座標値に変換された後、上記実施の形態１と同様に加減速部４、補間部５および座標逆変換部６において各処理がセグメント単位で行われる。アルゴリズムとしては前述の実施の形態１と同様で、同様の効果がある。
【００４０】
図１１に、本発明を円弧に対して適用する場合を示す。
図１１において、Ｓはセグメント作成部で作成されるセグメントであり、同一番号、同一符号は上述の場合と同様のものを示す。また、図１１（ｉ）はプログラム、図１１（ｉｉ）はプログラム座標系、図１１（ｉｉｉ）本発明の加減速を行うための指令値を表す座標系、図１１（ｉｖ）、および図１１（ｖ）はそれぞれ本発明の加減速を行うための指令値を表す座標系上に示す速度パターン、およびプログラム座標系上に示す速度パターンである。
【００４１】
プログラムが図１１（ｉ）のように与えられている場合、プログラムが示す座標値ＸｐおよびＹｐはプログラム指令を行う指令値を表すプログラム座標系上の座標値を指し、指令速度は４０、ブロックＮ１でＸｐ＝１４１、Ｙｐ＝０まで中心の座標（７１、−７１）の時計回りの円弧補間で移動する。
前述の図１０に示した上記セグメント作成部７において、図１１（ｉｉ）のように円弧を始点Ｐ１１から終点Ｐ１５の間に、例えばＰ１２からＰ１４の３点を均等な間隔でとり、円弧を４つのセグメントに分割すると、Ｐ１１〜Ｐ１５の各点のプログラム指令を行うための指令値を生成する座標系上の座標値ＸｐおよびＹｐは、各々（０、０）、（３２、２２）、（７１、２１）、（１０９、２２）、（１４１、０）となり、各セグメントの長さは３９となる。
この後、加減速を行うための指令値を表す座標系上の座標値に座標変換する座標変換部において、φ^−１を用いて上記Ｐ１１〜Ｐ１５の各点を座標変換すると、加減速を行うための指令値を表す座標系上のＰ１１〜Ｐ１４各点の座標値Ｘａ、Ｙａは、図１１（ｉｉｉ）に示すように各々（０、０）、（５４、−５）、（１００、−２１）、（１３１、−４４）、（１４１、−７１）となる。また、各セグメントの移動量Ｓ１１〜Ｓ１５の各座標値Ｘａ、Ｙａは、各々（５４、−５）、（４６、−１６）、（３１、−２３）、（１０、−２７）であり、Ｓ１１〜Ｓ１４各セグメントの長さは５４、４８、３８、２９となる。さらに、プログラム座標系上の指令速度４０に上記座標系上の各セグメントの長さに対する加減速を行うための指令値を表す座標系上の各セグメント長の比率を乗じると、加減速を行うための指令値を表す座標系上の各セグメントＳ１１〜Ｓ１４の指令速度Ｆは、各々５５、５０、３９、３０となる。
次いで加減速部において、上記指令経路Ｐと指令速度Ｆに対して、一定の加速度で加減速を行うと、図１１（ｉｖ）に示すような速度パターンが得られる。さらに、補間部において、上記速度パターンに基づいて補間を行い、その後座標逆変換部において、補間された座標値にφを乗じてプログラム座標系上の座標値に変換する。結果としてプログラム指令座標系上の合成速度は図１１（ｖ）に示した速度パターンとなる。
なお、セグメント分割を細かくすれば、速度パターンの波形はより滑らかにできる。本発明では、ひとつのブロック内においても移動方向に応じて加速度を変えることができるので従来法に比べ加工時間が短縮される。
【００４２】
上述のように、本発明では指令要素を分割したセグメント毎に座標系変換処理を行うため、指令要素中においても時々刻々と加減速のための座標系を切り替えることができ、結果として指令要素中で移動方向が変わる場合であっても、効率の良い加減速処理が容易に、かつ乱れることなく実現できる。
なお、本実施の形態では一定の加速度で加減速を行う場合について述べたが、そのほかにも、時定数一定型の移動平均フィルタを用いたり、一次／二次／ｎ次遅れ型加減速を用いたり、或いは一定の加速度で加減速を行う場合を含めてこれらの組み合わせを用いたりしても同様の効果がある。
【００４３】
実施の形態３．
図１２は本発明の実施の形態３における指令値生成部の構成図であり、プログラム指令を行うための指令値を表す座標系が、駆動対象の備える各軸の単位移動量を要素とする座標系、すなわち機械座標系と異なる場合のものである。
図１２において、３００は指令値生成部、８は座標逆変換部の後に設けられた座標変換部で、座標逆変換部６でプログラム座標系に変換された位置指令を機械座標系上の位置指令に座標変換するものであり、ｊ１は分岐点を示す。
例えば第一の座標系上の位置指令θ、および第二の座標系上の位置ｐは、一般に非線形の関係ｐ＝Ｈｐ（θ）として与えられる。ここで関数Ｈｐ（θ）は駆動対象の可動間の幾何学的関係や上記第一の座標系の取り方に依存して決まるもので、関数Ｈｐ（θ）のヤコビアンをＪｐ（θ）と置く。
【００４４】
次に、加減速を行うための指令値を表す座標系として、プログラム座標系を正規化した座標系を用いる場合の動作について述べる。
図１２において、プログラム座標系上の指令経路Ｐｐおよび指令速度Ｆｐは、座標変換部３で座標変換される。すなわちプログラム座標系上の各軸の許容加速度をＡｐ１〜Ａｐｎ、Ａｐ１〜Ａｐｎを対角成分にもつ行列をψとして、ψの逆行列ψ^-1を用いてＰａ＝ψ^-1（Ｐｐ）、Ｆａ＝ψ^-1（Ｆｐ）により加減速を行うための指令値を表す座標系上の指令経路Ｐａおよび指令速度Ｆａに座標変換する。次いで加減速部４、補間部５で上述の実施の形態１と同様の処理を行った後、座標逆変換部６において、Ｑｐ＝ψ×Ｑａの関係から加減速を行うための指令値を表す座標系上の位置指令Ｑａをプログラム座標系上の位置指令Ｑｐに変換する。さらに、座標変換部８において、Ｑｍ＝Ｈｐ^-1（Ｑｐ）の関係から駆動対象の備える各軸の単位移動量を要素とする第一の座標系、すなわち機械座標系上の位置指令Ｑｍに変換する。
【００４５】
次に、加減速を行うための指令値を表す座標系として、駆動対象の備える各軸の単位移動量を要素とする第一の座標系、すなわち機械座標系を正規化した座標系を用いる場合の動作について述べる。
前処理部の動作は上述の場合と同様である。座標変換部３において、駆動対象の備える各軸の許容加速度をＡ１〜Ａｎ、上記Ａ１〜Ａｎを対角成分にもつ行列をφとし、φの逆行列φ^-1を用いて、Ｐａ＝φ^-1×Ｈｐ^-1（Ｐｐ）、Ｆａ＝φ^-1×Ｊｐ^-1（Ｆｐ）の関係に基づきプログラム座標系上の指令経路Ｐｐおよび指令速度Ｆｐを、加減速を行うための指令値を表す座標系上の指令経路Ｐａおよび指令速度Ｆａに変換する。続いて、加減速部４、補間部５において、上述の場合と同様の処理を行った後、座標逆変換部６において、Ｑｐ＝Ｈｐ（φ×Ｑａ）の関係から位置指令Ｑａをプログラム座標系上の位置指令Ｑｐに変換し、さらに、座標変換部８において、Ｑｍ＝Ｈｐ^-1（Ｑｐ）の関係から駆動対象の備える各軸の単位移動量を要素とする第一の座標系、すなわち機械座標系上の位置指令Ｑｍに変換する。
【００４６】
上述のように、本発明によれば、プログラム指令を行うための指令値を表す第二の座標系や駆動対象の備える各軸の単位移動量を要素とする第一の座標系、すなわち機械座標系とは独立に加減速を行うための指令値を表す第三の座標系を設計でき、性能も向上できる。例えば実施の形態１と同様に、加減速を行うための指令値を表す座標系として、駆動対象の備える各軸の座標系を軸ごとの許容加速度で正規化した座標系を選べば、駆動対象の備える各軸の出しうる加速度をフルに活用して短時間に移動を完了し、かつその波形が乱れることなく、また簡単に加減速処理、加工処理を実現することができる。またプログラム座標系が目的とする作業を表している場合、或いは機械座標系よりもプログラム座標系の方が目的とする作業を表す座標系に近い場合には、プログラム座標系を正規化した座標系を、加減速を行うための指令値を表す座標系とすることで、作業目的に合致した制御を実現することが出来る。なお、上述の実施例では、座標逆変換部６の後に座標変換部８を設けたが、前処理部１の前または後に設置しても良い。
【００４７】
実施の形態４．
図１３にプログラム作成装置において直接、第三座標系である加減速座標系上の指令速度が指令される場合の実施例を示す。同一番号、同一符号は同一のものを表す。
図１３に示すように、先ず、プログラム作成装置において、プログラム座標系上の指令経路と加減速座標系上の指令速度が作成され、上記作成された指令経路と指令速度が指令値生成部に指令され、前処理されてバッファに格納される。次いで、指令経路Ｐｐは座標変換部３において加減速座標系上の数値に変換され、指令速度Ｆａはバッファから直接、加減速部４に送られ、加減速部４において加減速座標系上の指令経路Ｐａと指令速度Ｆａおよび加速度Ａｃに基づき加減速される。上記の場合においても前述の実施例と同様の効果がある。
なお、図１３ではプログラム作成装置において、指令速度が加減速座標系上の座標値に変換されて指令値生成部に指令される場合について述べたが、プログラムで指令するのは、少なくとも加減速座標系に変換された指令速度、指令経路のいずれかで一方で良く、いずれの場合についても同様の効果がある。
【００４８】
実施の形態５．
図１４は本発明のプログラム作成装置および指令値生成システムと、加工機の関係を示すブロック図である。
図１４において、６０はＣＡＤ／ＣＡＭなどのプログラム作成装置、７０はＮＣ装置などの指令値生成システム、８０は上記指令値生成システム７０によって駆動制御される加工機、９０は上記加工機の駆動対象である。同一番号、同一符号は同一のものを表す。
【００４９】
また、図１５は本発明のプログラム作成装置の構成を示すブロック図である。
図１５において、５１は指令経路および指令速度の計算部、５２、５３はプログラム座標系上の指令経路、指令速度、５４は座標変換部、５５は加減速座標系上の指令速度、５６はプログラム出力部である。同一番号、同一符号は同一のものを表す。
【００５０】
次に、動作について説明する。
図１５に示すように、工具、被加工物、要求加工精度などに基づいて、指令経路および指令速度の計算部５１においてプログラム座標系上の指令経路および指令速度が計算され、次いで指令速度５３は座標変換部５４で加減速座標系上の座標値に変換される。上記加減速座標系上の座標値に変換された指令速度５５はプログラム座標系上の指令経路５２とともにプログラム出力部５６に送られる。上記プログラム出力部に送られた加減速座標系上の指令速度とプログラム座標系上の指令経路は、プログラム出力部５６から指令値生成システムに指令される。その後は、ＮＣ装置などの指令値生成システムの指令値生成部において上述の実施例と同様に指令値生成され、加減速処理される。
上述の例では、プログラム作成装置においてプログラム座標系上の指令速度を加減速座標系上の数値に変換してプログラム指令する場合について述べたが、指令経路を加減速座標系上の座標値に変換してプログラム指令しても良く、少なくとも指令経路、指令速度のいずれか一方を加減速座標系上の数値に変換して、プログラム指令し、加減速処理することで前述の場合と同様の効果が得られる。
【００５１】
【発明の効果】
以上のように、本発明は、駆動対象が備える各軸の単位移動量を要素とする第一の座標系、プログラム指令する際に基準として用いる第二の座標系、および上記第一の座標系を上記駆動対象が備える各軸の許容加速度で正規化した第三の座標系をそれぞれ設け、上記第三の座標系上で指令速度および指令経路を座標変換し、上記第三の座標系上の加減速パラメータに基づいて駆動対象が備える各軸の加減速を行うための指令値を生成するようにしたことにより、円滑かつ効率よく加減速処理が実現でき遅れやずれのない高性能な指令値生成方法および指令値生成システムを提供できるものである。
【図面の簡単な説明】
【図１】本発明の指令値生成部を示す構成図。
【図２】本発明の指令値生成方法を示す流れ図。
【図３】本発明による実施の形態１の実施例を示す図。
【図４】本発明による実施の形態１の実施例を示す図。
【図５】本発明による実施の形態１の速度パターンを示す図。
【図６】本発明による実施の形態１の実施例を示す図。
【図７】本発明による実施の形態１の速度パターンを示す図。
【図８】本発明による実施の形態１の実施例を示す図。
【図９】本発明による実施の形態１の実施例を示す図。
【図１０】本発明の指令値生成部を示す構成図。
【図１１】本発明による実施の形態２の実施例を示す図。
【図１２】本発明の指令値生成部を示す構成図。
【図１３】本発明の指令値生成部を示す構成図。
【図１４】本発明のシステム全体の構成図。
【図１５】本発明のプログラム作成装置を示す構成図。
【図１６】従来の指令値生成方法の流れ図。
【図１７】従来の指令値生成部を示す構成図。
【符号の説明】
１前処理部、２バッファ、３座標変換部、４加減速部、５補間部、６座標逆変換部、７セグメント作成部、８座標変換部、５１指令経路および指令速度の計算部、５２プログラム座標系上の指令経路、５３プログラム座標系上の指令速度、５４座標変換部、５５加減速座標系上の指令速度、５６プログラム出力部、６０プログラム作成装置、７０指令値生成システム、８０加工機、８１前処理部、８２バッファ、８３指令経路、８４指令速度、８５加速度計算部、８６加減速部、８７補間部、９０駆動対象、１００指令値生成部、２００指令値生成部、３００指令値生成部、４００指令値生成部、５００駆動制御システム、６００プログラム作成装置、Ａ加速度、Ａｃ′ 移動方向の加速度、Ｂ指令要素、Ｆ指令速度、Ｇ１直線補間、Ｇ９０絶対座標値モード、Ｎブロック、Ｐ指令経路、Ｑ指令位置、ＳＶサーボ制御部各軸、Ｕ単位長さ、Ｖａ加減速後速度、Ｖｋ加減速後速度、Ｘａ加減速座標系上のＸ軸、Ｙａ加減速座標系上のＹ軸、Ｘｍ機械座標系上のＸ軸、Ｙｍ機械座標系上のＹ軸、Ｘｐプログラム座標系上のＸ軸、Ｙｐプログラム座標系上のＹ軸、Ｘｗ機械座標系上のＸ軸、Ｙｗ機械座標系上のＹ軸。[0001]
BACKGROUND OF THE INVENTION
The present invention relates to various manufacturing apparatuses such as semiconductor manufacturing apparatuses, elevators, escalators, sewing machines, coordinate measuring instruments, plotters, transport apparatuses, transportation equipment such as automobiles, trains and airplanes, or drive systems including a plurality of shafts such as toys and the like. The present invention relates to a command value generation method of a control device and a command value generation system thereof, and in particular, a processing machine, a robot, and a molding machine that operate according to a command from a command value generation system such as a numerical control device so-called NC device or robot controller. Command value generation method for generating command values for the drive system that performs the desired motion by integrating the motions of multiple axes, etc. and Command value generation system To It is related.
[0002]
[Prior art]
In a command value generation system that generates a command value for an object to be driven, such as a numerical controller, a so-called NC device or robot controller, a program command is issued by a program creation device such as CAD / CAM that creates a program for commanding the command value generation system. Based on the command path and the command speed, each movable part corresponding to each axis is provided by giving a command value for operating each axis to a plurality of axes held by a driving target such as a robot or a processing machine. Are operated at the same time, and the target work is performed by the total operation of the movable parts. At this time, the command value generation system generates a command value for accelerating / decelerating each movable part and automatically accelerating / decelerating each movable part with respect to the feed speed commanded by the program. It is common to realize a proper operation.
FIG. 16 shows a flowchart in the conventional command value generation method. In FIG. 16, F is a command speed, P is a command path, t is time, V is a speed, and X and Y are coordinate axes.
In the conventional method, as shown in FIG. 16, the procedure for generating the command value for each servo axis from the program is performed as “preprocessing”, “acceleration / deceleration”, “interpolation” and “coordinate conversion”. Is called. That is, the command speed and command path are programmed by a program creation device such as CAD / CAM that performs programming, etc., and the command speed and command path are read by a numerical control system such as an NC device, Preprocessing is performed such as calculating a certain command speed F40, a length along a curve from the command path P1 to P2, and the like. Next, acceleration / deceleration is performed to smooth the speed in the direction along the command path. Based on the acceleration / deceleration speed Vk after the acceleration / deceleration, the amount of movement per unit time, that is, the acceleration / deceleration from the current position Pk. Interpolation is performed to calculate the position Pk + 1 advanced by an amount corresponding to the product of the post-deceleration speed Vk and the interpolation cycle dt to obtain the coordinate value of each axis. Furthermore, by converting the coordinate value on the program coordinate system into a coordinate system whose element is the unit movement amount of each axis of the drive target according to the machine structure, that is, a coordinate value on the machine coordinate system Smooth command values for each servo axis are created. The acceleration / deceleration in the above-described conventional method is generally called acceleration / deceleration before interpolation, and has the advantage that no trajectory error due to delay due to acceleration / deceleration occurs, but the acceleration of each axis does not exceed a predetermined allowable acceleration. There was a restriction that it had to be controlled.
[0003]
FIG. 17 is a configuration diagram of a command value generation unit in a command value generation system such as an NC apparatus showing a conventional command value generation method described in Japanese Patent Laid-Open No. 03-078006. In FIG. 17, reference numeral 800 denotes an entire command value generation unit, 81 denotes a preprocessing unit that performs preprocessing such as interpretation and correction of commands on commanded command elements, and 82 denotes preprocessing performed by the preprocessing unit 81. Buffers for storing command elements, 83 and 84 are command paths and command speeds in the command elements stored in the buffer 82, respectively, and 85 is an acceleration for obtaining an allowable acceleration in the moving direction from the command path 83 and the allowable acceleration of each axis. The calculation unit 86 is an acceleration / deceleration unit that performs acceleration / deceleration based on the allowable acceleration in the moving direction obtained by the acceleration calculation unit 85 and the command path 83 and the command speed 84, and 87 is accelerated / decelerated by the acceleration / deceleration unit 86. The interpolation unit obtains the command position on the real axis coordinate system corresponding to each servo control unit by performing interpolation from the acceleration / deceleration speed and the command path 83 as a result.
A is an allowable acceleration in the moving direction in which the movable part moves, which is obtained by the acceleration calculator 85, A1 to An are allowable accelerations of each axis of the movable part composed of a plurality of axes, B is a command element commanded by the program, Bd is a command element after pre-processing by the pre-processing unit 81, SV1 to SVn are axes corresponding to the servo control units, and Va is a speed after acceleration / deceleration that is a result of acceleration / deceleration by the acceleration / deceleration unit 86. Indicates.
[0004]
Next, the operation will be described.
As shown in FIG. 17, the command element B created by the program creation unit is first subjected to preprocessing such as command interpretation and correction by the preprocessing unit 81 in the command value generation unit in the command value generation unit 800. And is stored in the buffer 82 as a preprocessed command element Bd. The command path 83 and the command speed 84, which are the constituent elements of the command element Bd stored in the buffer 82, are obtained from the permissible acceleration A1 to An of the respective axes in the acceleration calculation unit 85 of the command value generation unit. After being obtained, the acceleration / deceleration unit 86 performs acceleration / deceleration based on the allowable acceleration A in the moving direction, the command path 83 and the command speed 84 of the command element Bd. Next, interpolation is performed by the interpolation unit 87 from the post-acceleration / deceleration speed Va, which is the result of acceleration / deceleration, and the command path 83 of the command element Bd stored in the buffer 82. After the command element Bd is interpolated by the interpolation unit 87 in this way, finally, a position command on the actual axis coordinate system of each axis SV1 to SVn corresponding to each servo control unit is obtained. The characteristic point here is that the acceleration calculating unit 85 obtains the allowable acceleration in the moving direction determined by the command path of the command element stored in the buffer 82 in accordance with the allowable accelerations A1 to An of each axis. The acceleration can be switched depending on the direction and direction.
[0005]
As described above, the acceleration / deceleration processing in the conventional command value generation method requires switching acceleration for each command element to be programmed or for every fixed period, and therefore complicated calculation must be frequently performed. The amount of calculation required for the acceleration / deceleration processing increases, resulting in problems such as an increase in machining time and a disturbed speed pattern during acceleration / deceleration. In particular, when performing acceleration / deceleration processing over a plurality of blocks using prefetching, there is a problem that the amount of calculation becomes extremely large and is not suitable for practical use. Also, the program coordinate system used as a reference when programming the command path and command speed is generally different from the work coordinate system that represents the coordinate values of the work tool with respect to the work target. If not, it is difficult to perform advanced control such as trajectory control, force control, disturbance compensation, and various error corrections in the prior art. As described above, in the prior art, it is difficult to easily realize a smooth and high-performance drive that has a short machining time due to a command value generation method and the like, and that there is little disturbance in the speed pattern during acceleration / deceleration. .
[0006]
The present invention has been made to solve the problems of the conventional command value generation method, command value generation system, and program creation device as described above, and can perform acceleration / deceleration processing easily and efficiently in a short time. It is an object of the present invention to provide a command value generation method, a command value generation system and a program creation device capable of realizing high-performance and smooth driving without delay or deviation.
[0007]
[Means for Solving the Problems]
The command value generation method according to the first configuration according to the present invention includes a plurality of axes, operates a movable part corresponding to each of the plurality of axes, and adds a drive target for performing a target work based on the total of the operations. In a command value generation method for generating a command value for performing deceleration, a first coordinate system having a unit movement amount of each axis included in the drive target as an element, a program command Use as a reference when Second coordinate system , and The first coordinate system is normalized by the allowable acceleration of each axis included in the drive target Each has a third coordinate system, At least one of the command path for commanding the command and the command speed is converted into a command value on the third coordinate system for accelerating / decelerating, and the coordinate-converted command value and the third coordinate system are converted. Based on acceleration / deceleration parameters, acceleration / deceleration of the drive target is performed. It is what I did.
[0010]
According to the present invention two In the command value generation method with the above configuration, the third coordinate system is a coordinate system representing a work tool for a work target.
[0012]
According to the present invention three In the command value generation method with the above configuration, the interpolation for interpolating the acceleration / deceleration operation of each axis of the drive target is performed using any one of the first to third coordinate systems.
[0013]
According to the present invention Four The command value generation system with the configuration of the above includes a plurality of axes, operates a movable portion corresponding to each of the plurality of axes, and commands to perform acceleration / deceleration of a drive target that performs a target work by a total of the operations In the command value generation system for generating a value, the drive target is Prepare The first coordinate system with the unit travel of each axis as an element , Program directive Use as a reference when Second coordinate system , And the first coordinate system normalized by the allowable acceleration of each axis included in the drive target With a third coordinate system, At least one of the command path for commanding the command and the command speed is converted into a command value on the third coordinate system for performing acceleration / deceleration, On the third coordinate system of Acceleration / deceleration parameters When On the basis of the the above Accelerate / decelerate the drive target U Is.
[0015]
DETAILED DESCRIPTION OF THE INVENTION
Embodiment 1 FIG.
FIG. 1 shows a configuration diagram of a command value generation unit in a command value generation system such as an NC device according to the present invention. In FIG. 1, 100 is a command value generation unit of the present invention, 1 is a preprocessing unit that performs preprocessing such as interpretation and correction of commands on commanded command elements, and 2 is the preprocessing unit 1 described above. A buffer for storing the preprocessed command element B, 3 is a coordinate conversion unit for converting the command path Pm and the command speed Fm of the command element stored in the buffer 2 into a command path Pa and a command speed Fa, respectively. The acceleration / deceleration unit 5 that performs acceleration / deceleration based on the command path Pa, the command speed Fa, and the acceleration Ac that are coordinate-converted by the coordinate conversion unit 3 is a post-acceleration / deceleration speed Va that is the result of acceleration / deceleration in the acceleration / deceleration unit 4. And an interpolation unit that performs an interpolation process from the command path Pa coordinate-converted by the coordinate conversion unit 3, and a position command Qa interpolated by the interpolation unit 5 on the machine coordinate system corresponding to each axis of each servo control unit. A coordinate reverse conversion unit that converts the position command Qm.
[0016]
FIG. 2 shows a flowchart of the command value generation method according to the present invention. In FIG. 2, F is a command speed, P is a command path, t is time, V is a speed, and X and Y are coordinate axes.
As shown in FIG. 2, the flow of the command value generation method according to the present invention is as follows. When the command speed and the command path are programmed, pre-processing is first performed as in the conventional method, and the pre-processed command speed and The command path is coordinate-converted into a third coordinate system representing a command value for performing acceleration / deceleration before acceleration / deceleration, and then accelerated / decelerated. Next, based on the post-acceleration / deceleration speed Vk, a movement amount per unit time from the current position Pk, that is, a position Pk + 1 advanced by an amount corresponding to the product of the post-acceleration / deceleration speed Vk and the interpolation cycle dt is calculated. Interpolation to obtain the coordinate value of is performed, the coordinate is converted again to the program coordinate system, and further, from the coordinate value on the program coordinate system to the coordinate value on the machine coordinate system according to the machine structure, Smooth command values for each servo axis are created.
[0017]
Next, the operation of the command value generation unit shown in FIG. 1 will be described.
First, the command element B commanded by the program is read in the command speed Fm and command path Pm commanded by the coordinate system representing the command value for performing the program command in the preprocessing unit 1 of the command value generating unit 100. The command speed, length, etc. are calculated and preprocessed, and stored in the buffer 2 as the command element Bd after the preprocess. The command speed Fm and command path Pm of the command element Bd stored in the buffer 2 are command values for performing acceleration / deceleration different from the coordinate system representing the command value for performing the program command in the coordinate conversion unit 3. Is converted into a command path Pa and a command speed Fa by an acceleration / deceleration coordinate system which is a third coordinate system representing Next, based on the command path Pa, the command speed Fa and the acceleration Ac numerically converted by the acceleration / deceleration coordinate system representing the command value for performing acceleration / deceleration, the acceleration / deceleration unit 4 increases the speed in the direction along the path. Smoothing acceleration / deceleration processing is performed. Thereafter, in the interpolating unit 5, based on the accelerated / decelerated speed Va and the command path Pa, the amount of movement per unit time from the current position, that is, the product of the speed after acceleration / deceleration and the interpolation cycle dt. Interpolation processing is performed to calculate the coordinate value of each axis by calculating the position Pk + 1 advanced by the distance. Further, in the coordinate inverse conversion unit 6, the coordinate value of each axis subjected to the interpolation processing, that is, the command position Qa on the acceleration / deceleration coordinate system, is determined by the machine corresponding to each servo axis SV1 to SVn from the numerical value on the acceleration / deceleration coordinate system. It is converted into a numerical value on the coordinate system, that is, a smooth position command Qm.
[0018]
By the way, in the present invention, as a coordinate system representing a command value for performing acceleration / deceleration by the acceleration / deceleration unit 4, a first coordinate system and a program having a unit movement amount of each axis included in the drive target as an element are performed. A third coordinate system representing a command value for acceleration / deceleration different from the second coordinate system representing the command value is used. The third coordinate system representing the command value for performing acceleration / deceleration is different from the first coordinate system and the second coordinate system, for example, in that the minimum unit amount of at least one coordinate axis is different, or the coordinate axis So that the direction of the coordinate system is different, the origin of the coordinate axes is different, the number of axes included in the coordinate system is different, or the types of coordinate systems are different such as Cartesian coordinate system, oblique coordinate system, polar coordinate system, cylindrical coordinate system, etc. Use this third coordinate system to specify acceleration / deceleration parameters such as speed, acceleration, jerk, time constant, accuracy, etc. in each axis of the third coordinate system or in the composite direction. Based on this, acceleration / deceleration processing is performed on the third coordinate system.
[0019]
FIG. 3 shows a case where a coordinate system obtained by normalizing the program coordinate system with the allowable acceleration for each axis is used as the third coordinate system.
In FIG. 3, Ax and Ay are the allowable accelerations in the X-axis direction and Y-axis direction, F is the command speed, G90 is the absolute coordinate value mode, G1 is linear interpolation, N is the block, P is the coordinate position, and U is the acceleration / deceleration A unit movement amount on the coordinate system representing a command value for performing X, X is an X-axis coordinate value, and Y is a Y-axis coordinate value. 3 (i) is a program, FIG. 3 (ii) is a program coordinate system, and FIG. 3 (iii) is an acceleration / deceleration coordinate system representing command values for acceleration / deceleration.
[0020]
As shown in FIG. 3 (ii), the program command value in FIG. 3 (i) is given by coordinate values Xp, Yp on the program coordinate system, the command speed F is 40, and the position P1, that is, Xp = 4 is programmed to move to Yp = 0 by linear interpolation and then move to position P2, ie, Xp = 4, Yp = 4, by linear interpolation at block N2. For example, the allowable acceleration Ax in the X-axis direction on the program coordinate system is 1, and the allowable acceleration Ay in the Y-axis direction is 2. At this time, the third coordinate system representing the command value for acceleration / deceleration is set so that the origin and the coordinate system X-axis and Y-axis are in the same direction as the program coordinate system, and the unit movement amounts Ax and Ay in the respective axis directions are respectively set. 1 and 2 are set as shown in FIG.
[0021]
Next, FIG. 4 shows an example of calculation using a coordinate system obtained by normalizing the program coordinate system with an allowable acceleration for each axis.
In FIG. 4, Ax and Ay are the allowable acceleration in the X-axis direction and the allowable acceleration in the Y-axis direction, and φ is a coordinate transformation matrix. FIG. 4 (i) shows a program, and FIG. 4 (ii) shows an acceleration / deceleration coordinate system representing command values for acceleration / deceleration.
[0022]
When the coordinate values on the coordinates representing the command value for performing the program command are represented by Xp and Yp, respectively, the coordinate values Xa and Ya on the third coordinate system representing the command value for performing acceleration / deceleration are: It is given by the equation as shown in FIG. For example, the coordinate values Xa and Ya of the point Op in the acceleration / deceleration coordinate system representing the command value for performing acceleration / deceleration are 0 and 0, respectively, the coordinate values Xa and Ya of the point P1 are 4, 0 and the coordinate values of the point P2, respectively. Xa and Ya are 4 and 2, respectively. At this time, in the acceleration / deceleration coordinate system which is the third coordinate system representing the command value for performing acceleration / deceleration, the movement amount of the block N1 is ΔXa = 4, ΔYa = 0, the length is 4, and the movement amount of the block N2 is ΔXa = 0, ΔYa = 2, and the length is 2. Further, when the speed is calculated so that the moving speed is proportional to the length, the moving speed of the block N1 is 40 × 4/4 = 40, and the moving speed of the block N2 is 40 × 2/4 = 20. FIG. 4 (ii) As shown in
[0023]
FIG. 5 shows a speed pattern when the command value generation method according to the present invention is implemented in comparison with the conventional one. The same number and the same symbol represent the same thing.
In FIG. 5, (i) is a conventional speed pattern, (ii) and (iii) are the speed patterns of the present invention, the horizontal axis is time, and the vertical axis is the composite speed.
[0024]
In the conventional command value generation method, acceleration / deceleration is performed using a constant acceleration on the coordinate system representing a command value for performing a program command, that is, the lowest acceleration of the Xp axis and the Yp axis, that is, A = 1. As a result, the speed pattern as shown in FIG.
On the other hand, according to the present invention, the third coordinate system representing the command value for acceleration / deceleration is normalized by the allowable acceleration of each axis, and the characteristics (allowable acceleration) for each axis are all equal and all are set to 1. Become. In the acceleration / deceleration unit, acceleration / deceleration is performed at a constant acceleration with respect to the command system path and command speed in FIG. 4 (ii) described above on the acceleration / deceleration coordinate system having the same characteristics for each axis. As a result, a speed pattern as shown in FIG. 5 (ii) is obtained. Interpolation is performed based on this speed pattern, and the interpolated coordinate value is multiplied by a coordinate conversion matrix φ to convert it to a numerical value on the coordinate system representing a command value for performing a program command again. That is, numerical conversion is performed by the relational expression Qm = φ × Qa between the position command Qa on the acceleration / deceleration coordinate system which is a third coordinate system representing the command value for performing acceleration / deceleration and the position command Qm on the machine coordinate system. The When the above relational expression is differentiated twice, the acceleration A on the machine coordinate system is the product of φ and the acceleration (maximum 1) on the third coordinate system representing the command value for acceleration / deceleration. It can be seen that the allowable acceleration is not exceeded. The synthesized speed on the program coordinate system at this time becomes a speed pattern as shown in FIG. 5 (iii). As a result, the movement of the block N2 on the program coordinate system is accelerated / decelerated at an acceleration A = 2. The processing time can be shortened compared to the conventional method.
[0025]
As described above, in the present invention, the third coordinate system representing the command value for performing the acceleration / deceleration process is normalized by the allowable acceleration, so that a constant acceleration can be used as the acceleration / deceleration process. Since the command to each servo control unit according to the allowable acceleration of each axis can be easily obtained with simple acceleration / deceleration processing without disturbing the pattern, it takes the same time as switching the acceleration according to the moving direction etc. It is possible to finish the movement.
[0026]
In addition to the above, by using the work coordinate system representing the work tool for the work object as the third coordinate system representing the command value for accelerating / decelerating, control that matches the work purpose can be realized. . For example, in an articulated robot composed of two axes, a machine in which a pair of two axes are parallel and another pair of two axes are parallel, a machine in which two axes are not orthogonal to each other, or a machine in which a linear axis and a rotary axis are combined, When the coordinate values of each axis of the machine are commanded to the program, the coordinate system representing the work tool for each work target is an orthogonal coordinate system based on the workpiece, and the command values for acceleration / deceleration using this coordinate system Acceleration / deceleration is performed by paying attention to the coordinate value corresponding to the tool tip on the coordinate system as a third coordinate system representing the above.
[0027]
FIG. 6 shows an embodiment in which a work coordinate system representing a work tool is used as the third coordinate system.
In FIG. 6, Xa and Ya are the third coordinate system, respectively, the X-axis, Y-axis, Xp, and Yp on the acceleration / deceleration coordinate system are the X-axis, Y-axis, Xw, and Yw on the program coordinate system. The upper X axis and the Y axis, and θ is the inclination angle between the workpiece and the X axis on the program coordinate system. The same number and the same symbol represent the same thing. 6 (i) is a work coordinate system on the program coordinate system, FIG. 6 (ii) is an acceleration / deceleration coordinate system, and FIG. 6 (iii) is a diagram showing speed and length on the acceleration / deceleration coordinate system.
[0028]
First, it is assumed that the X axis of the program coordinate system is provided in the horizontal direction of the paper, and the Y axis is provided in the vertical direction, and the workpiece is placed at a position rotated by θ = 45 ° with respect to the program coordinate system. . Further, in order to machine the machining surface of the workpiece, the movement in the direction parallel to the machining surface is performed by linear interpolation from the command speed F = 40 to Xp = 3 and Yp = 3 in block N1, and in block N2. Assume that a program command is given to move to Xp = 1 and Yp = 5. The relationship between the work coordinate system and the program coordinate system at this time is as shown in FIG. 6 (i). Further, when the work coordinate system is used as a third coordinate system, that is, an acceleration / deceleration coordinate system, The relationship of the acceleration / deceleration coordinate system is as shown in FIG. The origin of the acceleration / deceleration coordinate system is (0, 0), the Xa axis is 45 ° direction, the unit length Uxa is √2 / 2, the Ya axis is 135 ° direction, and the unit length Uya is √2. Further, when the movement speed is determined so as to be proportional to the coordinate value, the length, and the length on the acceleration / deceleration coordinate system from the relational expression between the program coordinate system and the acceleration / deceleration coordinate system, each is shown in FIG. 6 (iii). Thus, the moving length 6 of N1, the moving speed 57, the moving length 2 of N2, and the moving speed 28 are obtained.
[0029]
FIG. 7 shows a speed pattern when the command value generation method of the present invention is implemented in comparison with the conventional method.
In FIG. 7, A is an acceleration, and the same code | symbol represents the same thing. 7 (i) is a speed pattern of the conventional method, FIG. 7 (ii) is a speed pattern on the acceleration / deceleration coordinate system of the present invention, and FIG. 7 (iii) is a program coordinate when the command value generation method of the present invention is executed. The speed pattern on the system is shown.
[0030]
In the prior art, acceleration / deceleration is performed using a constant acceleration on the program coordinates, that is, √2 / 2 which is the minimum acceleration of the Xp axis and the Yp axis. Therefore, the speed pattern as shown in FIG.
According to the command value generation method of the present invention, since the acceleration / deceleration coordinate system is normalized by the allowable acceleration of each axis, the acceleration is 1 for any axis on the acceleration / deceleration coordinate system. Therefore, acceleration / deceleration is performed at a constant acceleration 1 with respect to the command path and command speed shown in FIG. 6 (iii) described above, resulting in a speed pattern as shown in FIG. 7 (ii). When interpolation is performed based on the speed pattern and converted again to coordinate values on the program coordinate system, the combined speed on the program coordinate system becomes a speed pattern as shown in FIG. 7 (iii). As a result, according to the method of the present invention, the movement of N2 is accelerated / decelerated at the acceleration A = √2 on the program coordinate system, and the machining time is shortened compared to the conventional method.
[0031]
FIG. 8 shows an embodiment in which the acceleration is changed according to the moving direction based on the allowable acceleration for each axis.
In FIG. 8, A is acceleration, F is speed, N is a block, P is a command path, and U is a unit length. 8 (i) shows a program coordinate system, and FIG. 8 (ii) shows an acceleration / deceleration coordinate system.
[0032]
As shown in FIG. 8 (i), it is assumed that a command speed F = 40 on the program coordinate system is commanded to move by linear interpolation to Xp = 4 and Yp = 3 in the block N1. The allowable accelerations Ax and Ay of the X axis and Y axis on the program coordinate system are 1 and 2, respectively. From the relationship between the acceleration / deceleration coordinate system and the program coordinate system, as shown in FIG. 8 (ii), the coordinate values Xa and Ya on the acceleration / deceleration coordinate system are 4, 1.5, velocity F = 34, acceleration in the moving direction, respectively. Ac 'is 1.25. Thus, in the method of the present invention, since the acceleration can be made larger than when the constant acceleration 1 is used regardless of the direction as in the conventional method, the processing time can be shortened.
[0033]
FIG. 9 shows an embodiment in which only the axial direction is changed as the acceleration / deceleration coordinate system, and the allowable acceleration on the acceleration / deceleration coordinate system is different for each axis.
In FIG. 9, Ac ′ is the acceleration in the moving direction, Aax and Aay are allowable accelerations on the acceleration / deceleration coordinate system, and Ajx and Aji are allowable accelerations on the program coordinate system. The same number and the same symbol represent the same thing. 9 (i) shows the program coordinate system, FIG. 9 (ii) shows the acceleration / deceleration coordinate system, and FIG. 9 (iii) shows the relationship between the program coordinate system and the acceleration / deceleration coordinate system.
[0034]
As shown in FIG. 9 (i), it is assumed that a command speed F on the program coordinate system F = 40 and a command is given to move by linear interpolation to Xp = 0 and Yp = 4 in the block N1. Also, as shown in FIG. 9 (ii), the Xa axis and Ya axis on the acceleration / deceleration coordinate system are 45 ° direction and 135 ° direction inclination, unit lengths are 1 and 1, respectively, and allowable acceleration Aax, Aay is set to √2 / 2 and √2, respectively. As shown in FIG. 9 (iii), from the relationship between the program coordinate system and the acceleration / deceleration coordinate system, the acceleration Ac ′ in the moving direction is the minimum value of the accelerations at which the accelerations of the respective axes reach the allowable acceleration, Ac ′ = 1. The set value is higher than the conventional method in which the set value is limited to the minimum allowable acceleration on the program coordinate system. Thus, when there is anisotropy of allowable acceleration in a direction different from the program coordinate system or the machine coordinate system, the command value generation method of the present invention has an effect that the movement can be completed in a short time.
[0035]
Note that the coordinate system for generating command values for acceleration / deceleration is not limited to the above-mentioned allowable acceleration of each axis, but also the allowable speed, allowable load torque, reduction ratio, allowable vibration level, allowable vibration level of each axis. You may normalize by error etc. Further, a value obtained by normalizing at least one of these including a permissible acceleration with a value obtained by combining a predetermined functional expression may be used, and in that case, a plurality of indices can be considered simultaneously. .
[0036]
In addition, although the case where acceleration / deceleration is performed at a constant acceleration has been described here, a moving average filter with a constant time constant type is used, or primary / secondary / n-order delay type acceleration / deceleration is used. These combinations may be used, including the case where acceleration / deceleration is performed at a certain acceleration, and in particular, in order to achieve both short movement time and smooth acceleration / deceleration operation, after acceleration / deceleration at a constant acceleration, It is very effective to provide a post filter (S-shaped filter) such as a moving average filter. Other coordinate systems that represent command values for acceleration / deceleration include coordinate systems obtained by rotating the machine coordinate system, coordinate systems transformed by multiplying an arbitrary primary transformation matrix, and nonlinear transformations. You may use the coordinate system which performed arbitrary conversion.
[0037]
In the above example, it is assumed that the servo control unit receives the position command, and the command value generation unit is configured to transmit the position command to the servo control unit. However, the servo control unit transmits other data such as a speed command. In the case of receiving an acceleration command, the command value generation unit generates a speed command or an acceleration command by differentiating the position command, for example, once or twice, and transmits it to the servo control unit.
[0038]
Embodiment 2. FIG.
Here, a description will be given of a case where the moving direction changes every moment even in command elements such as arcs, spline curves, and NURBS curves, and the coordinate system for acceleration / deceleration is changed every moment even in the command elements.
FIG. 10 is a block diagram showing the configuration of the command value generation unit of the command value generation system according to Embodiment 2 of the present invention.
In FIG. 10, reference numeral 200 denotes a command value generation unit, and 7 denotes a segment creation unit that creates a segment by dividing the command path Pm stored in the buffer 2. Further, Pm1 is a command path for each segment, Fm1 is a command speed for each segment, Pa1 is a command path for each segment, and an acceleration / deceleration coordinate system representing a command value for performing acceleration / deceleration that is the third coordinate system. The command path coordinate-converted to the above value, Fa1, indicates the command speed obtained by coordinate-converting the command speed Fm1 for each segment into a value on the acceleration / deceleration coordinate system representing the command value for performing the third acceleration / deceleration. The same numbers and the same reference numerals are the same as those in the above case.
[0039]
Next, the operation will be described.
In the operation, the segment creation unit 7 in the command value generation unit 200 creates a command path Pm1 and a command speed Fm1 obtained by segmenting the command element Bd preprocessed and stored in the buffer. Next, after the command path Pm1 and the command speed Fm1 are converted into coordinate values on the third coordinate system representing command values for acceleration / deceleration in the coordinate conversion unit 3, the same as in the first embodiment. In the acceleration / deceleration unit 4, the interpolation unit 5, and the coordinate inverse conversion unit 6, each process is performed in units of segments. The algorithm is the same as that of the first embodiment and has the same effect.
[0040]
FIG. 11 shows a case where the present invention is applied to an arc.
In FIG. 11, S is a segment created by the segment creation unit, and the same numbers and the same symbols indicate the same as in the above case. 11 (i) is a program, FIG. 11 (ii) is a program coordinate system, FIG. 11 (iii) a coordinate system representing command values for performing acceleration / deceleration of the present invention, FIG. 11 (iv), and FIG. (V) is the speed pattern shown on the coordinate system showing the command value for performing the acceleration / deceleration of the present invention, and the speed pattern shown on the program coordinate system.
[0041]
When the program is given as shown in FIG. 11 (i), the coordinate values Xp and Yp indicated by the program indicate the coordinate values on the program coordinate system representing the command values for performing the program commands, the command speed is 40, and the block N1 Then, it moves by X-axis clockwise interpolation of the center coordinates (71, -71) up to Xp = 141 and Yp = 0.
In the segment creating unit 7 shown in FIG. 10 described above, as shown in FIG. 11 (ii), an arc is formed between the start point P11 and the end point P15, for example, three points P12 to P14 are evenly spaced, and the arc is changed to 4 When divided into two segments, the coordinate values Xp and Yp on the coordinate system for generating command values for performing program commands for the points P11 to P15 are (0, 0), (32, 22), (71, respectively. , 21), (109, 22), (141, 0), and the length of each segment is 39.
Thereafter, in the coordinate conversion unit that converts the coordinate value to the coordinate value on the coordinate system representing the command value for acceleration / deceleration, φ ^-1 When the points P11 to P15 are coordinate-converted using the above, the coordinate values Xa and Ya of the points P11 to P14 on the coordinate system representing the command values for acceleration / deceleration are as shown in FIG. 11 (iii). (0, 0), (54, -5), (100, -21), (131, -44), and (141, -71). Also, the coordinate values Xa and Ya of the movement amounts S11 to S15 of each segment are (54, -5), (46, -16), (31, -23), and (10, -27), respectively. The length of each segment of S11 to S14 is 54, 48, 38, and 29. Further, when the command speed 40 on the program coordinate system is multiplied by the ratio of each segment length on the coordinate system representing the command value for performing acceleration / deceleration with respect to the length of each segment on the coordinate system, acceleration / deceleration is performed. The command speeds F of the segments S11 to S14 on the coordinate system representing the command values are 55, 50, 39, and 30, respectively.
Next, when the acceleration / deceleration unit accelerates / decelerates the command path P and the command speed F at a constant acceleration, a speed pattern as shown in FIG. 11 (iv) is obtained. Further, the interpolation unit performs interpolation based on the speed pattern, and then the coordinate inverse conversion unit multiplies the interpolated coordinate value by φ to convert it to a coordinate value on the program coordinate system. As a result, the combined speed on the program command coordinate system becomes the speed pattern shown in FIG.
If the segmentation is made finer, the waveform of the speed pattern can be made smoother. In the present invention, since the acceleration can be changed in accordance with the moving direction even within one block, the machining time is shortened as compared with the conventional method.
[0042]
As described above, in the present invention, since the coordinate system conversion process is performed for each segment obtained by dividing the command element, the coordinate system for acceleration / deceleration can be switched from moment to moment even in the command element. Even when the moving direction changes, efficient acceleration / deceleration processing can be realized easily and without being disturbed.
In this embodiment, the case where acceleration / deceleration is performed at a constant acceleration has been described. In addition to this, a moving average filter with a constant time constant type or primary / secondary / n-order delay type acceleration / deceleration is used. Even if these combinations are used including acceleration / deceleration at a constant acceleration, the same effect can be obtained.
[0043]
Embodiment 3 FIG.
FIG. 12 is a configuration diagram of the command value generation unit according to the third embodiment of the present invention, in which a coordinate system representing a command value for performing a program command is a coordinate having a unit movement amount of each axis included in the drive target as an element. The system is different from the machine coordinate system.
In FIG. 12, 300 is a command value generation unit, 8 is a coordinate conversion unit provided after the coordinate reverse conversion unit, and the position command converted into the program coordinate system by the coordinate reverse conversion unit 6 is the position command on the machine coordinate system. And j1 represents a branch point.
For example, the position command θ on the first coordinate system and the position p on the second coordinate system are generally given as a non-linear relationship p = Hp (θ). Here, the function Hp (θ) is determined depending on the geometric relationship between the movable objects to be driven and how to take the first coordinate system, and the Jacobian of the function Hp (θ) is set as Jp (θ). .
[0044]
Next, the operation when a coordinate system obtained by normalizing the program coordinate system is used as the coordinate system representing the command value for acceleration / deceleration will be described.
In FIG. 12, the command path Pp and the command speed Fp on the program coordinate system are coordinate-converted by the coordinate conversion unit 3. In other words, the allowable acceleration of each axis on the program coordinate system is Ap1 to Apn, and the matrix having Ap1 to Apn as diagonal components is ψ, and the inverse matrix ψ of ψ ^-1 Using Pa = ψ ^-1 (Pp), Fa = ψ ^-1 The coordinates are converted into a command path Pa and a command speed Fa on the coordinate system representing a command value for performing acceleration / deceleration by (Fp). Next, after the acceleration / deceleration unit 4 and the interpolation unit 5 perform the same processing as in the first embodiment, the coordinate inverse conversion unit 6 represents a command value for performing acceleration / deceleration from the relationship of Qp = ψ × Qa. The position command Qa on the coordinate system is converted into a position command Qp on the program coordinate system. Further, in the coordinate conversion unit 8, Qm = Hp ^-1 From the relationship of (Qp), it is converted into a position command Qm on the first coordinate system, that is, the machine coordinate system, with the unit movement amount of each axis included in the drive target as an element.
[0045]
Next, when a coordinate system representing command values for acceleration / deceleration is used, the first coordinate system using the unit movement amount of each axis included in the drive target as an element, that is, a coordinate system normalized with the machine coordinate system The operation of is described.
The operation of the preprocessing unit is the same as that described above. In the coordinate conversion unit 3, the allowable acceleration of each axis included in the drive target is A1 to An, the matrix having the above A1 to An as diagonal components is φ, and the inverse matrix φ of φ ^-1 Using Pa = φ ^-1 × Hp ^-1 (Pp), Fa = φ ^-1 × Jp ^-1 Based on the relationship (Fp), the command path Pp and the command speed Fp on the program coordinate system are converted into a command path Pa and a command speed Fa on the coordinate system representing the command values for acceleration / deceleration. Subsequently, after the acceleration / deceleration unit 4 and the interpolation unit 5 perform the same process as described above, the coordinate inverse conversion unit 6 determines the position command Qa from the relationship of Qp = Hp (φ × Qa) in the program coordinate system. Is converted into the above position command Qp, and further, in the coordinate conversion unit 8, Qm = Hp ^-1 From the relationship of (Qp), it is converted into a position command Qm on the first coordinate system, that is, the machine coordinate system, with the unit movement amount of each axis included in the drive target as an element.
[0046]
As described above, according to the present invention, the second coordinate system representing the command value for performing the program command and the first coordinate system having the unit movement amount of each axis of the drive target as an element, that is, the machine coordinate A third coordinate system representing a command value for accelerating / decelerating can be designed independently of the system, and the performance can be improved. For example, as in the first embodiment, as a coordinate system representing a command value for performing acceleration / deceleration, if a coordinate system obtained by normalizing the coordinate system of each axis included in the drive target with the allowable acceleration for each axis is selected, the drive target The acceleration that each axis can provide can be fully utilized to complete the movement in a short time, and the acceleration / deceleration processing and machining processing can be easily realized without disturbing the waveform. Also, when the program coordinate system represents the target work, or when the program coordinate system is closer to the coordinate system representing the target work than the machine coordinate system, the coordinate system obtained by normalizing the program coordinate system By adopting a coordinate system that represents command values for acceleration / deceleration, it is possible to realize control that matches the work purpose. In the above-described embodiment, the coordinate conversion unit 8 is provided after the coordinate reverse conversion unit 6, but it may be installed before or after the preprocessing unit 1.
[0047]
Embodiment 4 FIG.
FIG. 13 shows an embodiment in the case where the command speed on the acceleration / deceleration coordinate system which is the third coordinate system is directly commanded in the program creation device. The same number and the same symbol represent the same thing.
As shown in FIG. 13, first, in the program creation device, a command path on the program coordinate system and a command speed on the acceleration / deceleration coordinate system are created, and the created command path and command speed are sent to the command value generation unit. Is preprocessed and stored in a buffer. Next, the command path Pp is converted into a numerical value on the acceleration / deceleration coordinate system by the coordinate conversion unit 3, and the command speed Fa is sent directly from the buffer to the acceleration / deceleration unit 4. Acceleration / deceleration is performed based on the path Pa, the command speed Fa, and the acceleration Ac. Even in the above case, the same effect as the above-described embodiment is obtained.
In FIG. 13, the case where the command speed is converted into a coordinate value on the acceleration / deceleration coordinate system and commanded to the command value generation unit in the program creation device has been described. Either the command speed or the command path converted into the system may be used, and the same effect is obtained in either case.
[0048]
Embodiment 5 FIG.
FIG. 14 is a block diagram showing the relationship between the program creation device and the command value generation system of the present invention and the processing machine.
In FIG. 14, 60 is a program creation device such as CAD / CAM, 70 is a command value generation system such as an NC device, 80 is a processing machine driven and controlled by the command value generation system 70, and 90 is a drive target of the processing machine. It is. The same number and the same symbol represent the same thing.
[0049]
FIG. 15 is a block diagram showing the configuration of the program creation apparatus of the present invention.
In FIG. 15, 51 is a command path and command speed calculator, 52 and 53 are command paths and command speeds on the program coordinate system, 54 is a coordinate converter, 55 is a command speed on the acceleration / deceleration coordinate system, and 56 is a program. It is an output unit. The same number and the same symbol represent the same thing.
[0050]
Next, the operation will be described.
As shown in FIG. 15, on the basis of the tool, workpiece, required machining accuracy, etc., the command path and command speed calculation unit 51 calculates the command path and command speed on the program coordinate system. The coordinate conversion unit 54 converts the coordinate value on the acceleration / deceleration coordinate system. The command speed 55 converted into the coordinate value on the acceleration / deceleration coordinate system is sent to the program output unit 56 together with the command path 52 on the program coordinate system. The command speed on the acceleration / deceleration coordinate system and the command path on the program coordinate system sent to the program output unit are commanded from the program output unit 56 to the command value generation system. Thereafter, a command value is generated in a command value generation unit of a command value generation system such as an NC device in the same manner as in the above-described embodiment, and acceleration / deceleration processing is performed.
In the above example, a case has been described in which the program creation device converts the command speed on the program coordinate system into a numerical value on the acceleration / deceleration coordinate system and issues a program command. However, the command path is converted to a coordinate value on the acceleration / deceleration coordinate system. The program command may be used, and at least one of the command path and the command speed is converted into a numerical value on the acceleration / deceleration coordinate system, programmed, and accelerated / decelerated. can get.
[0051]
【The invention's effect】
As described above, the present invention A first coordinate system having a unit movement amount of each axis included in the drive target as an element, a second coordinate system used as a reference when programming, and each axis included in the drive target including the first coordinate system A third coordinate system normalized by the allowable acceleration is provided. The command speed and command path are coordinate-converted on the third coordinate system, and command values for accelerating / decelerating each axis of the drive target are generated based on the acceleration / deceleration parameters on the third coordinate system By doing so, acceleration / deceleration processing can be realized smoothly and efficiently, and a high-performance command value generation method and command value generation system free from delays and deviations can be provided.
[Brief description of the drawings]
FIG. 1 is a configuration diagram showing a command value generation unit of the present invention.
FIG. 2 is a flowchart showing a command value generation method of the present invention.
FIG. 3 is a diagram showing an example of the first embodiment according to the present invention.
FIG. 4 is a diagram showing an example of the first embodiment according to the present invention.
FIG. 5 is a diagram showing a speed pattern according to the first embodiment of the present invention.
FIG. 6 is a diagram showing an example of the first embodiment according to the present invention.
FIG. 7 is a diagram showing a speed pattern according to the first embodiment of the present invention.
FIG. 8 is a diagram showing an example of the first embodiment according to the present invention.
FIG. 9 is a diagram showing an example of the first embodiment according to the present invention.
FIG. 10 is a configuration diagram showing a command value generation unit of the present invention.
FIG. 11 is a diagram showing an example of the second embodiment according to the present invention.
FIG. 12 is a configuration diagram showing a command value generation unit of the present invention.
FIG. 13 is a block diagram showing a command value generation unit of the present invention.
FIG. 14 is a configuration diagram of the entire system of the present invention.
FIG. 15 is a block diagram showing a program creation device of the present invention.
FIG. 16 is a flowchart of a conventional command value generation method.
FIG. 17 is a configuration diagram illustrating a conventional command value generation unit.
[Explanation of symbols]
DESCRIPTION OF SYMBOLS 1 Pre-processing part, 2 Buffer, 3 Coordinate conversion part, 4 Acceleration / deceleration part, 5 Interpolation part, 6 Coordinate reverse conversion part, 7 Segment creation part, 8 Coordinate conversion part, 51 Command path and command speed calculation part, 52 program Command path on the coordinate system, 53 Command speed on the program coordinate system, 54 Coordinate conversion unit, 55 Command speed on acceleration / deceleration coordinate system, 56 Program output unit, 60 Program creation device, 70 Command value generation system, 80 Processing machine , 81 Preprocessing unit, 82 Buffer, 83 Command path, 84 Command speed, 85 Acceleration calculation unit, 86 Acceleration / deceleration unit, 87 Interpolation unit, 90 Drive target, 100 Command value generation unit, 200 Command value generation unit, 300 Command value Generation unit, 400 command value generation unit, 500 drive control system, 600 program creation device, A acceleration, Ac ′ acceleration in moving direction, B Command element, F command speed, G1 linear interpolation, G90 absolute coordinate value mode, N block, P command path, Q command position, each axis of SV servo control unit, U unit length, Va speed after acceleration / deceleration, Vk after acceleration / deceleration Speed, Xa X axis on acceleration / deceleration coordinate system, Ya Y axis on acceleration / deceleration coordinate system, Xm X axis on machine coordinate system, Ym Y axis on machine coordinate system, Xp X axis on program coordinate system, Yp Y axis on program coordinate system, Xw X axis on machine coordinate system, Yw Y axis on machine coordinate system.

Claims

In a command value generation method that includes a plurality of axes, generates a command value for accelerating / decelerating a drive target that performs a desired work by operating a movable portion corresponding to each of the plurality of axes. , A first coordinate system having a unit movement amount of each axis included in the drive object as an element, a second coordinate system used as a reference when performing a program command , and each of the drive objects provided with the first coordinate system provided a third coordinate system normalized with the axis of the permissible acceleration, respectively, the program at least one command to command path and the command speed is converted into the command value on the third coordinate system for performing acceleration and deceleration and the command value generation wherein the TURMERIC line acceleration and deceleration of the driven object based on the acceleration and deceleration parameters on the command value obtained by converting the coordinates and the third coordinate system.

The third coordinate system, the command value generating method according to 請 Motomeko 1 you, characterized in that a coordinate system representing the work tool for work.

Interpolation acceleration and deceleration operations of each axis drive subject has the generated command value according to 請 Motomeko 1 or 2 you, characterized in that to perform with any of the first to third coordinate system Method.

In a command value generation system that includes a plurality of axes, generates a command value for accelerating or decelerating a drive target that performs a desired work by operating a movable portion corresponding to each of the plurality of axes. a first coordinate system with elements the unit movement amount of each axis in which the drive object is provided, a second coordinate system used as a reference when the program instruction, and the driven object is provided with the first coordinate system A third coordinate system normalized by the allowable acceleration of each axis is provided, and at least one of the command path to be programmed and the command speed is converted to the command value on the third coordinate system for acceleration / deceleration and the command value generation system comprising a TURMERIC line acceleration and deceleration of the driven object based on the acceleration and deceleration parameters on the command value obtained by converting the coordinates and the third coordinate system.