JPH03142159A - Push pressure control type grinding device - Google Patents

Push pressure control type grinding device

Info

Publication number
JPH03142159A
JPH03142159A JP28098989A JP28098989A JPH03142159A JP H03142159 A JPH03142159 A JP H03142159A JP 28098989 A JP28098989 A JP 28098989A JP 28098989 A JP28098989 A JP 28098989A JP H03142159 A JPH03142159 A JP H03142159A
Authority
JP
Japan
Prior art keywords
grinding
force
deviation
spring constant
pressing force
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP28098989A
Other languages
Japanese (ja)
Other versions
JPH0651268B2 (en
Inventor
Kazunori Yamada
一徳 山田
Kunio Kashiwagi
柏木 邦雄
Tooru Kurenuma
透 榑沼
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.)
Hitachi Construction Machinery Co Ltd
Original Assignee
Hitachi Construction Machinery 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 Hitachi Construction Machinery Co Ltd filed Critical Hitachi Construction Machinery Co Ltd
Priority to JP1280989A priority Critical patent/JPH0651268B2/en
Publication of JPH03142159A publication Critical patent/JPH03142159A/en
Publication of JPH0651268B2 publication Critical patent/JPH0651268B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Landscapes

  • Constituent Portions Of Griding Lathes, Driving, Sensing And Control (AREA)
  • Finish Polishing, Edge Sharpening, And Grinding By Specific Grinding Devices (AREA)

Abstract

PURPOSE:To perform a grinding work with a constant push pressure irrespective of the size of a residual grinding quantity by composing it so as to find a virtual spring constant from the grinding deviation so that a desired push pressure is obtainable even in case of the residual grinding quantity becoming less with equipping a push pressure setting part and spring constant arithmetic setting part. CONSTITUTION:A push preassure setting means 32 for setting a push pressure necessary for grinding work and a grinding deviation calculating means 36 finding the grinding deviation on each optional gap in the moving direction of a grinding tool 7 based on the finishing position of a work and the positional data of the grinding tool 7 output from a position detecting means 34 are provided. Then, a virtual spring constant is calculated by an arithmetic part 33 so that the push pressure becomes the set value set on the push pressure setting means 32, based on the output value of the push pressure setting means 32 and that of a grinding deviation calculating means 36 and this virtual spring constant is set by a spring constant arithmetic setting means 40 on a control means 26.

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は押し圧制御式研削装置に関し、特に位置と力の
制御が行われる研削装置であって、研削工具の押し圧が
常に設定された所望値に制御される押し圧制御式研削装
置に関するものである。
[Detailed Description of the Invention] [Industrial Application Field] The present invention relates to a pressure-controlled grinding device, and particularly to a grinding device in which position and force are controlled, in which the pressure of the grinding tool is always set. The present invention relates to a pressure-controlled grinding device that is controlled to a desired value.

〔従来の技術〕[Conventional technology]

従来、産業用ロボットでは位置と力を制御することによ
って多自由度作業機械に所定の作業を行わせる仮想コン
プライアンス制御方式が提案されている(特開昭62−
35915号公報等)。
Conventionally, for industrial robots, a virtual compliance control method has been proposed that allows a multi-degree-of-freedom working machine to perform a predetermined task by controlling its position and force (Japanese Patent Application Laid-Open No. 1983-1999).
35915, etc.).

般に、この制御方式を備える作業機械では、そのアーム
のリスト部に力センサを配設し、この力センサを介して
作業用工具を取り付ける。そして、制御装置において工
具の運動特性を決定する仮想の質量、バネ定数、粘性減
衰係数等の制御パラメータを設定し、この設定値と、外
部から供給される基準位置姿勢指令、工具に加わる力情
報、実際の工具の位置や姿勢の情報などに基づき、工具
の速度指令値を演算し、この指令値が制御装置から駆動
回路を経由して工具の駆動装置に供給される。
Generally, in a working machine equipped with this control system, a force sensor is disposed on the wrist of the arm, and a working tool is attached via this force sensor. Then, control parameters such as virtual mass, spring constant, viscous damping coefficient, etc. that determine the motion characteristics of the tool are set in the control device, and these set values, reference position and orientation commands supplied from the outside, and force information applied to the tool are set. A speed command value for the tool is calculated based on information on the actual position and orientation of the tool, and this command value is supplied from the control device to the tool drive device via the drive circuit.

この結果、工具はワークの形状に倣って移動し、研削作
業を行う。仮想コンプライアンス制御では、制御装置で
指定される工具が移動すべき位置と実際の工具の存在位
置との偏差、及び制御パラメータとして設定されている
仮想バネ定数によって、その偏差に応じたバネ力を算出
し、このバネ力をワークに対する工具の押付は力として
、工具に対し力目標指令値を与える。このようにソフト
ウェアによって実現される上記制御方式によって、研削
作業を行う工具に、あたかも本当の機械的バネ機構が付
設されているかのような運動特性を与えることができる
As a result, the tool moves to follow the shape of the workpiece and performs the grinding operation. Virtual compliance control calculates the spring force according to the deviation between the position where the tool should move specified by the control device and the actual position of the tool, and the virtual spring constant set as a control parameter. However, this spring force is used as force when pressing the tool against the workpiece, and a target force command value is given to the tool. The above-mentioned control system realized by software can give a tool for grinding a motion characteristic as if it were equipped with a real mechanical spring mechanism.

〔発明が解決しようとする課題〕[Problem to be solved by the invention]

従来の仮想コンプライアンス制御に従って動作する研削
装置では、位置と力を制御することにより、ある程度工
具をワークに押付けながら研削加工を行うことができる
。しかし、従来装置の制御方式によれば、ワークの仕上
げ位置に対して削り残し部分が生じる等の不具合が発生
し、削り取る量に対応した工具の押付は力の調整という
ことに十分な配慮が行われていなかった。更に具体的に
述べれば、例えば、工具に対し押し圧を加える方向のバ
ネ定数が固定された値である場合には、研削作業が進行
し削り残し量が少なくなるに従って、仮想的に設定され
たバネ要素が実質的に伸びた状態になるので、工具の押
し圧が減少し、そのためワーク面に対し十分な研削を行
うことができず、削り残しが生じることになる。また押
し圧方向のバネ定数を変化することができる制御方式を
備えた研削装置では、押し圧方向のバネ定数が大きな値
に設定されており且つワーク面において削り取る量が多
い場合には研削装置にとって過負荷状態が発生し、反対
に押し圧方向のバネ定数が小さな値に設定されており且
つ同じくワーク面において削り取る量が少ない場合には
負荷不足の状態になるという不具合が生じる。
With a grinding device that operates according to conventional virtual compliance control, by controlling the position and force, it is possible to perform grinding while pressing the tool against the workpiece to some extent. However, with the control method of conventional equipment, problems such as leaving uncut parts at the finished position of the workpiece occur, and sufficient consideration has been given to adjusting the force to press the tool according to the amount to be removed. It wasn't. More specifically, for example, if the spring constant in the direction of applying pressure to the tool is a fixed value, the spring constant may be set virtually as the grinding work progresses and the amount of uncut material decreases. Since the spring element is in a substantially stretched state, the pressing force of the tool is reduced, so that the workpiece surface cannot be sufficiently ground, resulting in uncut parts. In addition, in a grinding device equipped with a control system that can change the spring constant in the pressing direction, if the spring constant in the pressing direction is set to a large value and a large amount is removed from the work surface, the grinding device If an overload condition occurs, and on the other hand, if the spring constant in the pressing direction is set to a small value and the amount of scraping on the work surface is also small, then an underload condition will occur.

本発明の目的は、位置と力のフィードバックループを備
え、位置と力による制御の下に研削作業が実行される研
削装置において、研削工具の押し圧を所望の値に維持し
つつ研削終了位置を正確に制御することができ、被研削
部を良好な精度で研削し正確な仕上げ面を形成すること
ができる押し圧制御式研削装置を提供することにある。
An object of the present invention is to provide a grinding device that is equipped with a feedback loop of position and force and performs grinding work under the control of position and force, while maintaining the pressing force of a grinding tool at a desired value. It is an object of the present invention to provide a pressing force control type grinding device that can be accurately controlled, grind a part to be ground with good precision, and form an accurate finished surface.

本発明に係る前記押し圧制御式研削装置で採用される位
置と力の制御方式は、同様な機能を有するその他の多自
由度作業機械に適用することができる。
The position and force control system employed in the pressure-controlled grinding device according to the present invention can be applied to other multi-degree-of-freedom working machines having similar functions.

〔課題を解決するための手段〕[Means to solve the problem]

本発明に係る押し圧制御式研削装置は、研削工具に加わ
る少なくとも1軸の力を検出する力検出手段と、研削工
具の位置を検出する位置検出手段と、力検出手段と位置
検出手段のそれぞれで検出された力と位置のデータを用
いて研削工具の位置と力を制御する制御手段とを備え、
制御手段で設定される仮想バネ定数でワークに対する研
削工具の押し圧を決定する研削装置において、研削作業
上必要とされる押し圧を設定するための押し圧設足手段
と、ワークの仕上げ位置と位置検出手段が出力する研削
工具の位置データとに基づいて研削工具の移動方向の任
意の間隔ごとに研削偏差を求める研削偏差算出手段と、
押し圧設定手段の出力値と研削偏差算出手段の出力値に
基づき、押し圧が押し圧設定手段に設定された設定値と
なるように仮想バネ定数を算出し、この仮想バネ定数を
制御手段に設定するバネ定数演算設定手段とを備えるよ
うに構成される。
The pressing force control type grinding device according to the present invention includes a force detection means for detecting the force of at least one axis applied to the grinding tool, a position detection means for detecting the position of the grinding tool, and each of the force detection means and the position detection means. control means for controlling the position and force of the grinding tool using the force and position data detected by the grinding tool;
In a grinding device that determines the pressing force of a grinding tool against a workpiece using a virtual spring constant set by a control means, there is provided a pressing foot means for setting the pressing force required for grinding work, and a finishing position of the workpiece. Grinding deviation calculation means for calculating a grinding deviation at each arbitrary interval in the moving direction of the grinding tool based on the position data of the grinding tool outputted by the position detection means;
Based on the output value of the pressing force setting means and the output value of the grinding deviation calculating means, a virtual spring constant is calculated so that the pressing force becomes the set value set in the pressing force setting means, and this virtual spring constant is used as the control means. and a spring constant calculation setting means.

本発明による前記押し圧制御式研削装置は、研削偏差算
出手段で算出された研削偏差を取り込み、この算出され
た研削偏差と予め設定された偏差基準値とを比較して研
削作業を継続するか又は終了するかを判定する判定手段
を有することを特徴とする。
The pressing force control type grinding device according to the present invention takes in the grinding deviation calculated by the grinding deviation calculation means, compares the calculated grinding deviation with a preset deviation reference value, and continues the grinding operation. The present invention is characterized in that it has a determining means for determining whether the process is completed or terminated.

本発明による前記押し圧制御式研削装置は、力検出手段
の出力する力情報に基づいて研削作業を継続するか又は
終了するかを判定する判定手段を有することを特徴とす
る。
The pressing force control type grinding device according to the present invention is characterized in that it has a determining means for determining whether to continue or end the grinding work based on the force information output by the force detecting means.

また本発明に係る押し圧制御式研削装置は、前記の各構
成において、研削偏差算出手段が平均化処理手段を含み
、この平均化処理手段で、特定の研削作業区間について
任意の間隔ごとに求められた複数の前記研削偏差の平均
値を求め、この平均値の研削偏差を前記研削偏差算出手
段の出力値としたことを特徴とする。
Further, in the pressing force control type grinding device according to the present invention, in each of the above configurations, the grinding deviation calculation means includes an averaging processing means, and the averaging processing means calculates the grinding deviation at arbitrary intervals for a specific grinding work section. The average value of the plurality of grinding deviations obtained is calculated, and the grinding deviation of this average value is used as the output value of the grinding deviation calculation means.

〔作用〕[Effect]

本発明による押し圧制御式研削装置では、研削偏差算出
手段で被研削部の削り残りの量を求めその量に応じて仮
想バネ定数を求め、求められた新しい仮想バネ定数値を
制御手段に設定することにより、被研削部の削り残り量
が変化しても研削工具のワークに対する押し圧が所望の
一定押し圧となるように調整される。
In the pressing force control type grinding device according to the present invention, the amount of uncut material on the part to be ground is determined by the grinding deviation calculation means, the virtual spring constant is determined according to the amount, and the new virtual spring constant value thus determined is set in the control means. By doing so, even if the amount of uncut portion of the part to be ground changes, the pressing force of the grinding tool against the workpiece is adjusted to a desired constant pressing force.

また本発明による押し圧制御式研削装置では、研削偏差
と偏差基準値との比較により、又は力検出手段の出力す
る力情報により、研削作業を継続させるか否かを判定す
る判定手段を設けるため、研削作業の自動化を計ること
ができ、研削作業の能率及び仕上げ精度を高めることが
できる。
Further, the pressing force control type grinding device according to the present invention is provided with a determination means for determining whether or not to continue the grinding operation by comparing the grinding deviation with the deviation reference value or by force information output from the force detection means. , the grinding work can be automated, and the efficiency and finishing accuracy of the grinding work can be improved.

本発明による押し圧制御式研削装置では、平均化処理手
段で得られる研削偏差の平均値を用いて仮想バネ定数を
求め、特定の研削作業区間については所望の押し圧を発
生させる安定した値の仮想バネ定数を得ることができる
In the pressing force control type grinding device according to the present invention, a virtual spring constant is determined using the average value of the grinding deviation obtained by the averaging processing means, and a stable value that generates the desired pressing force is determined for a specific grinding work section. A virtual spring constant can be obtained.

〔実施例〕〔Example〕

以下に、本発明の実施例を添付図面に基づいて説明する
Embodiments of the present invention will be described below with reference to the accompanying drawings.

第1図は本発明に係る押し圧制御方式研削装置の全体構
成を示す。第1図において、1は研削装置本体で、複数
の関節部を有するアーム2が支持基台3に取付けられ、
アーム2の各関節部の可動作用により、アーム先部は作
業上必要とされる位置に移動し、アーム全体の姿勢は作
業上必要な姿勢に変化する。アーム2の先部に位置する
リスト部4に6軸の力センサ5が取付けられ、更に力セ
ンサ5の先には、ワーク6に対して研削作業を行う手先
効果器である研削工具7が取付けられている。8はコン
トローラであり、このコントローラ8内にはコンピュー
タ等で構成される制御手段が内蔵され、予め定められた
位置と力の制御のための演算式を用いて且つ所定の手順
で研削装置本体上に対し位置・力制御を実行する機能を
有している。コントローラ8は、信号ライン9で研削装
置本体上に対し研削作業の動作を指令するための指令信
号を与え且つ研削装置本体1からモータ等の動作情報を
得ると共に、力センサ5から研削工具7に加わる力及び
モーメントに関する検出信号、すなわち力信号10を取
り込むように相互に電気的に接続されている。11は作
業者が所持し、必要に応じ適時に操作する操作器であり
、テンキー及び各種の指令をコントローラ8に与えるこ
とのできる複数の操作スイッチが設けられている。操作
器11の各種の操作スイッチを作業者が操作することに
より、例えば作業動作の教示、作業条件の設定、更に後
述するように研削工具7の押し圧の設定、仕上げ位置に
対する研削偏差の基準値の設定等を行うことができる。
FIG. 1 shows the overall configuration of a pressing force control type grinding device according to the present invention. In FIG. 1, 1 is a grinding device main body, an arm 2 having a plurality of joints is attached to a support base 3,
Due to the movement of each joint of the arm 2, the tip of the arm moves to a position required for work, and the posture of the entire arm changes to the position required for work. A 6-axis force sensor 5 is attached to the wrist part 4 located at the tip of the arm 2, and a grinding tool 7, which is a hand effector that performs grinding work on the workpiece 6, is attached to the tip of the force sensor 5. It is being Reference numeral 8 denotes a controller, and this controller 8 has a built-in control means composed of a computer, etc., and uses predetermined calculation formulas for controlling the position and force and according to a predetermined procedure to control the grinding device main body. It has the function of performing position/force control on the The controller 8 gives a command signal for instructing the operation of the grinding work to the grinding device main body through a signal line 9, obtains operation information of the motor etc. from the grinding device main body 1, and also receives information from the force sensor 5 to the grinding tool 7. They are electrically connected to each other so as to receive detection signals, ie force signals 10, regarding applied forces and moments. Reference numeral 11 denotes an operating device that is carried by the operator and operated as needed, and is provided with a numeric keypad and a plurality of operating switches that can give various commands to the controller 8. By operating various operation switches of the operating device 11, the operator can, for example, teach the working operation, set the working conditions, and furthermore, as described later, set the pressing force of the grinding tool 7, and set the reference value of the grinding deviation with respect to the finishing position. settings, etc.

次に、第2図のブロック図に基づいてコントローラ8に
よって実現される本発明による制御機構の具体的構成に
ついて説明する。研削装置本体lに適用される本発明の
制御方式は、コントローラ8内に含まれるコンピュータ
等を利用してソフト的に又はその他のハード回路で実現
されるものであり、第2図は制御要素の構成が明確にな
るようにブロック図を示した。
Next, a specific configuration of the control mechanism according to the present invention realized by the controller 8 will be explained based on the block diagram of FIG. 2. The control method of the present invention applied to the grinding device main body l is realized by software or other hardware circuits using a computer included in the controller 8, and FIG. 2 shows a diagram of the control elements. A block diagram is shown to make the configuration clear.

第2図において、研削装置本体1の内部にはアーム2の
各関節部等を動かすための駆動モータ(図示せず)が複
数内蔵されている。これらの駆動モータにはその駆動量
を計測する角度計21が取り付けられており、この角度
計21によって各関節の軸角度データを得ることができ
る。
In FIG. 2, a plurality of drive motors (not shown) for moving each joint of the arm 2 are built into the grinding device main body 1. An angle meter 21 for measuring the amount of drive is attached to these drive motors, and the axis angle data of each joint can be obtained by this angle meter 21.

先ず位置・力制御演算系の構成から説明する。First, the configuration of the position/force control calculation system will be explained.

アーム先端に配置された力センサ5から出力される力及
びモーメントの信号は力演鼻部22に送給され、この力
演鼻部22で、センサ座標系から基準座標系(絶対座標
系)に変換すると共に研削工具7の重力分を差し引く重
力補償を行うことによりワークと研削工具7の接触点で
の力tを算出する。また前述の角度計21によって検出
される各1 軸の角度データは位置演算部23に送給され、位置演算
部23でこれらの角度データによって絶対座標系におけ
る研削工具7の位置と姿勢Xが算出される。そして、こ
の位置と姿勢Xは、位置目標値設定部24で設定された
位置の目標値xrと、位置偏差演算部25で比較され、
その位置偏差ΔXが求められる。なお、位置目標値設定
部24における位置目標値の設定の仕方については後で
詳しく説明する。上記のように、力演鼻部22で得られ
た力實と位置偏差演算部25で得られた位置と姿勢に関
する位置偏差ΔXはそれぞれ位置・力制御演算部26に
入力される。
The force and moment signals output from the force sensor 5 placed at the tip of the arm are sent to the force acting nose 22, and the force acting nose 22 transforms the sensor coordinate system into the reference coordinate system (absolute coordinate system). The force t at the point of contact between the workpiece and the grinding tool 7 is calculated by converting and performing gravity compensation by subtracting the gravitational force of the grinding tool 7. Further, the angle data of each axis detected by the angle meter 21 mentioned above is sent to the position calculation section 23, and the position and orientation X of the grinding tool 7 in the absolute coordinate system are calculated by the position calculation section 23 from these angle data. be done. Then, this position and attitude
The positional deviation ΔX is determined. Note that the method of setting the positional target value in the positional target value setting section 24 will be explained in detail later. As described above, the force performance obtained by the force acting nose section 22 and the position deviation ΔX regarding the position and posture obtained by the position deviation calculation section 25 are respectively input to the position/force control calculation section 26.

位置・力制御演算部26は、減算器27とバネ定数演算
部28と特性補償演算部29とから構成される。前記の
力演鼻部22の出力fは減算器27に与えられ、位置偏
差演算部25で得られた位置偏差ΔXはバネ定数演算部
28に入力される。
The position/force control calculation section 26 includes a subtracter 27, a spring constant calculation section 28, and a characteristic compensation calculation section 29. The output f of the force acting nose section 22 is given to a subtracter 27, and the positional deviation ΔX obtained by the positional deviation computing section 25 is input to a spring constant computing section 28.

バネ定数演算部28では仮想バネ定数行列Kが設定され
ている。バネ定数演算部28は、入力された位置偏差Δ
Xに設定された仮想バネ定数行列に 2 を乗算することによりにΔXを算出する。本実施例にお
いてバネ定数行列にの各軸の値は固定値ではなく、必要
に応じて適切な値に変化せしめられる。ワーク6に対し
研削工具7を押し付ける方向の仮想バネ定数は、後述す
るようにバネ定数演算設定部30によって演算される。
In the spring constant calculating section 28, a virtual spring constant matrix K is set. The spring constant calculation unit 28 calculates the input positional deviation Δ
ΔX is calculated by multiplying the virtual spring constant matrix set to X by 2. In this embodiment, the values of each axis in the spring constant matrix are not fixed values, but are changed to appropriate values as necessary. The virtual spring constant in the direction in which the grinding tool 7 is pressed against the workpiece 6 is calculated by the spring constant calculation and setting section 30 as described later.

バネ定数演算部28の出力にΔXは減算器27に与えら
れる。減算器27では、f−にΔXが計算され、この減
算器27の計算結果は特性補償演算部29に与えられる
。特性補償演算部29ではコントローラゲインKcが設
定されており、このKcによって入力されたf−にΔX
が制御上の特性補償を受け、特性補償演算部29で速度
指令値マが算出される。
ΔX is applied to the output of the spring constant calculating section 28 to a subtracter 27 . The subtracter 27 calculates ΔX to f−, and the calculation result of the subtracter 27 is given to the characteristic compensation calculation unit 29. A controller gain Kc is set in the characteristic compensation calculation section 29, and ΔX is applied to the input f- by this Kc.
is subjected to control characteristic compensation, and the characteristic compensation calculation section 29 calculates the speed command value M.

このようにして位置・力制御演算部26で求められた速
度指令値Vは駆動指令部31に供給され、この駆動指令
部31で速度指令値Vは研削装置本体1の各駆動モータ
の駆動指令値0に変換される。
The speed command value V thus obtained by the position/force control calculation section 26 is supplied to the drive command section 31, and the speed command value V is converted into a drive command for each drive motor of the grinding device main body 1 by this drive command section 31. Converted to value 0.

変換された駆動指令値0は研削装置本体tの各駆動モー
タに供給され、この指令値によってモータは動作する。
The converted drive command value 0 is supplied to each drive motor of the grinding device main body t, and the motors operate according to this command value.

次にバネ定数演算部28のバネ定数行列にの押し圧方向
のバネ定数値を変更する機能を有する前記バネ定数演算
設定部30について説明する。バネ定数演算設定部30
は、バネ定数演算部28で設定される研削工具による押
し圧方向の仮想バネ定数を逐次に演算し変更・設定する
制御系回路部分である。以下では、バネ□定数演算設定
部30の構成とその構成による仮想バネ定数の演算の仕
方を説明する。
Next, the spring constant calculation setting section 30 having the function of changing the spring constant value in the pressing direction in the spring constant matrix of the spring constant calculation section 28 will be explained. Spring constant calculation setting section 30
is a control system circuit portion that sequentially calculates, changes, and sets the virtual spring constant in the pressing direction by the grinding tool, which is set by the spring constant calculation unit 28. Below, the configuration of the spring constant calculation setting section 30 and how to calculate a virtual spring constant using that configuration will be explained.

バネ定数演算設定部30では、研削装置本体1がワーク
6に対し研削工具7で押し圧を加えるとき、押し圧の方
向の仮想バネ定数を、ワーク6の研削加工仕上げ位置と
現在加工中のワーク6の研削位置との差(距離)、換言
すれば仕上げ位置に対する削り残し量に応じて変更する
ように構成したことに特徴がある。
In the spring constant calculation setting unit 30, when the grinding apparatus main body 1 applies pressing force to the workpiece 6 with the grinding tool 7, a virtual spring constant in the direction of the pressing force is calculated between the grinding finishing position of the workpiece 6 and the workpiece currently being processed. It is characterized in that it is configured to be changed in accordance with the difference (distance) from the grinding position of No. 6, in other words, the amount of uncut material with respect to the finishing position.

32は押し圧設窓部であり、この押し圧設窓部32には
前記操作器11を作業者が操作することにより所望の押
し圧Fg+が設定される。この所望の押し圧Fgrとは
、研削装置本体1による研削作業において、研削工具7
が最大の能力を発揮できる押付は力、又はワーク6の材
質等に基づいて決定される最適な押付は力のことを意味
する。この押し圧Fg+は研削作業中一定の値に保持さ
れる。
Reference numeral 32 denotes a pressing window portion, and a desired pressing force Fg+ is set in this pressing window portion 32 by the operator operating the operating device 11. This desired pressing force Fgr means that the grinding tool 7 is
The pressing force that allows the maximum performance to be exerted is the force, or the optimum pressing determined based on the material of the workpiece 6, etc. means the force. This pressing force Fg+ is maintained at a constant value during the grinding operation.

押し圧設窓部32に設定された押し圧Fgrはバネ定数
演算部33に与えられる。
The pressing force Fgr set on the pressing window section 32 is applied to the spring constant calculation section 33.

一方、研削加工作業中において、位置演算部23で得ら
れた研削工具7の位置に関するデータは、位置抽出部3
4において任意の間隔、例えば所定の距離間隔で抽出さ
れる。位置抽出部34で抽出された研削工具7の位置デ
ータは仕上げ位置演算部35と研削偏差演算部36に供
給される。仕上げ位置演算部35は位置抽出部34で抽
出された研削工具の位置データに基づきワーク6の仕上
げ位置を演算する。この仕上げ位置については、作業開
始時に設定された仕上げ位置を用いても良い。
On the other hand, during the grinding work, the data regarding the position of the grinding tool 7 obtained by the position calculation unit 23 is transmitted to the position extraction unit 3.
4, the data are extracted at arbitrary intervals, for example, at predetermined distance intervals. The position data of the grinding tool 7 extracted by the position extraction section 34 is supplied to the finishing position calculation section 35 and the grinding deviation calculation section 36. The finishing position calculation unit 35 calculates the finishing position of the workpiece 6 based on the position data of the grinding tool extracted by the position extraction unit 34. As for this finishing position, the finishing position set at the start of the work may be used.

また、その既に設定されている仕上げ位置を用いて、そ
れから補間演算を適用して新たに仕上げ位置を算出する
ようにしても良い。そして、研削偏差演算部36は、位
置抽出部34で抽出された研5 削工具7の現在の研削位置と仕上げ位置演算部35で得
られた仕上げ位置に基づいて、押し圧を加えている方向
の研削偏差を算出し、これを次段の記憶部37に送給し
て、ここに記憶する。上記の研削偏差を△hi (i=
1.2.3・・・)と表す。この研削偏差は前記の任意
の距離間隔ごとに求められる。
Alternatively, a new finishing position may be calculated by using the finishing position that has already been set and then applying interpolation calculation. Then, the grinding deviation calculation unit 36 calculates the direction in which pressing force is being applied based on the current grinding position of the grinding tool 7 extracted by the position extraction unit 34 and the finishing position obtained by the finishing position calculation unit 35. The grinding deviation is calculated and sent to the storage section 37 at the next stage, where it is stored. The above grinding deviation is △hi (i=
1.2.3...). This grinding deviation is determined for each arbitrary distance interval.

38は平均化処理部であり、この平均化処理部38は、
一連の研削動作終了後、例えば指定された研削区間につ
き1回の研削動作が終了した後、前記の任意の距離間隔
ごとに演算され、且つ記憶部37に記憶された前記区間
におけるすべての研削偏差Δhiの値に基づいてそれら
の平均値Δhを求める。この場合の平均値の求め方とし
ては、例えば周知の算術平均が使用される。このように
して平均化処理部38で算出された特定の研削区間にお
ける研削偏差の平均値Δhは前記のバネ定数演算部33
と、後述する終了判定部39に与えられる。
38 is an averaging processing section, and this averaging processing section 38 is
After a series of grinding operations are completed, for example, after one grinding operation is completed for a designated grinding section, all the grinding deviations in the section are calculated for each arbitrary distance interval and stored in the storage unit 37. The average value Δh is determined based on the value of Δhi. In this case, the well-known arithmetic mean is used, for example, to determine the average value. The average value Δh of the grinding deviation in a specific grinding section calculated by the averaging processing section 38 in this way is calculated by the spring constant calculation section 33.
and is given to the end determination section 39, which will be described later.

バネ定数演算部33では、前記の所望の押し圧6 Fgrと平均値Δhを用いて、研削工具7からワーク6
に対して所望の押し圧Fg+が加わるようにするための
バネ定数Knを算出する。この算出式は下記の通りであ
る。
The spring constant calculation unit 33 uses the desired pressing force 6Fgr and the average value Δh to move the grinding tool 7 to the workpiece 6.
A spring constant Kn is calculated so that a desired pressing force Fg+ is applied to the spring. The calculation formula is as follows.

K n = F H/Δh このようにして求められたバネ定数Knは仮想バネ定数
設定部40に設定され、更にその設定値は前記位置・力
制御演算部26のバネ定数演算部28に与えられ、これ
によってバネ定数演算部28の仮想バネ定数行列にの押
し圧方向のバネ定数値が変更される。こうして所定の研
削区間について研削作業が終了するごとに、新しい所定
の区間の研削作業に関して押し圧方向のバネ定数が設定
される。
K n = F H /Δh The spring constant Kn thus obtained is set in the virtual spring constant setting section 40, and the set value is further given to the spring constant calculation section 28 of the position/force control calculation section 26. As a result, the spring constant value in the pressing direction in the virtual spring constant matrix of the spring constant calculation unit 28 is changed. In this way, each time the grinding operation for a predetermined section is completed, the spring constant in the pressing direction is set for the grinding operation for a new predetermined section.

次に終了判定部39について説明する。終了判定部39
は研削作業を継続すべきか、終了すべきかを判定する機
能を有し、比較判定部41とこの比較判定部41に偏差
基準値Hを与える偏差基準値設定部42とから構成され
る。比較判定部41には平均化処理部38から研削偏差
の平均値Δhと偏差基準値設定部42から偏差基準値H
とが入力され、この2つの値が比較される。そして、比
較判定部41は、Δh≦Hである時には研削作業を終了
する指令を出力し、その反対にΔh>Hである時には研
削作業を継続する指令を出力する。
Next, the end determination section 39 will be explained. End determination section 39
has a function of determining whether the grinding work should be continued or terminated, and is composed of a comparison and determination section 41 and a deviation reference value setting section 42 that provides a deviation reference value H to this comparison and determination section 41. The comparison judgment unit 41 receives the average value Δh of the grinding deviation from the averaging processing unit 38 and the deviation reference value H from the deviation reference value setting unit 42.
is input and these two values are compared. Then, when Δh≦H, the comparison/determination unit 41 outputs a command to end the grinding work, and on the other hand, when Δh>H, it outputs a command to continue the grinding work.

研削終了の指令及び研削作業継続の指令は次段の研削処
理演算部43に送給される。上記の偏差基準値設定部4
2で設定された偏差基準値Hは、例えば仕上げ公差など
の値である。
The command to end the grinding and the command to continue the grinding work are sent to the next-stage grinding processing calculation section 43. The above deviation reference value setting section 4
The deviation reference value H set in step 2 is, for example, a value such as a finishing tolerance.

次いで研削処理演算部43は、比較判定部41から研削
作業終了という指令を受けると、研削作業を終了する制
御手順を実行し、一方研削作業を継続の指令を受けると
、次の一連の研削動作のための作業経路の位置目標値を
演算し、この位置目標値を位置目標値設定部24に与え
、ここに設定する。
Next, when the grinding processing calculation unit 43 receives a command to end the grinding work from the comparison judgment unit 41, it executes a control procedure to end the grinding work, and on the other hand, when it receives a command to continue the grinding work, it starts the next series of grinding operations. The positional target value of the work route for is calculated, and this positional target value is given to the positional target value setting section 24 and set there.

第3図に上記の構成・作用を有する押し圧制御系に基づ
く研削装置本体1の研削作業動作の一例を示す。第3図
において、2はアーム、5は力センサ、7は研削工具、
6はワークである。50はワーク6の表面に削り残った
被研削部であり、研削工具7は被研削部50を仕上げ位
置Cまで研削する作業を行う。研削工具7による研削区
間は教示された点A、Bの間の直線状の区間であり、研
削工具7について第3図中2軸方向(図中上下方向)が
押し圧方向となり、X軸方向が移動方向となっている。
FIG. 3 shows an example of the grinding operation of the grinding device main body 1 based on the pressing force control system having the above configuration and operation. In Fig. 3, 2 is an arm, 5 is a force sensor, 7 is a grinding tool,
6 is a workpiece. 50 is a portion to be ground remaining on the surface of the workpiece 6, and the grinding tool 7 performs the work of grinding the portion to be ground 50 to a finishing position C. The grinding section by the grinding tool 7 is a linear section between the taught points A and B, and for the grinding tool 7, the 2-axis direction in FIG. 3 (vertical direction in the figure) is the pressing direction, and the X-axis direction is the direction of movement.

またワーク6の表面Cが仕上げ位置であり、その上方位
置に研削作業を終了させるための偏差基準値Hが設定さ
れている。この偏差基準値Hは前記偏差基準値設定部4
2に設定されている。かかる状態において、研削工具7
はA点からB点に向かって被研削部50を研削し、その
研削が終了すると再びA点に戻って同じように研削動作
を繰り返す。A点からB点へ移動する1回の研削動作に
おいて、AB間の距離はΔlで細かく分割される。この
距離Δlは、位置抽出部34が研削工具7の位置を適当
な間隔で抽出するための前述した任意の間隔である。
Further, the surface C of the workpiece 6 is the finishing position, and a deviation reference value H for finishing the grinding work is set above the surface C. This deviation reference value H is determined by the deviation reference value setting section 4.
It is set to 2. In this state, the grinding tool 7
grinds the part to be ground 50 from point A to point B, and when the grinding is finished, returns to point A and repeats the same grinding operation. In one grinding operation moving from point A to point B, the distance between AB is divided finely by Δl. This distance Δl is the above-described arbitrary interval for the position extraction unit 34 to extract the position of the grinding tool 7 at an appropriate interval.

第3図の状態は研削工具7が、A点からB点に向かって
研削作業を行いながら移動している状態9 を示している。この研削作業における押し圧方向のバネ
定数は、この直前の研削作業で得られた値が設定されて
いる。この研削作業において、研削動作を行いながら、
教示点Aから任意の距離間隔Δlごとに研削偏差Δhi
を求める。このΔh iは、前記の位置抽出部34と仕
上げ位置演算部35と研削偏差演算部36とによって求
められる。
The state shown in FIG. 3 shows a state 9 in which the grinding tool 7 is moving from point A to point B while performing a grinding operation. The spring constant in the pressing direction in this grinding operation is set to the value obtained in the immediately preceding grinding operation. In this grinding work, while performing the grinding operation,
Grinding deviation Δhi for each arbitrary distance interval Δl from teaching point A
seek. This Δh i is determined by the position extraction section 34, finishing position calculation section 35, and grinding deviation calculation section 36.

求められた研削偏差Δhiはそれぞれ記憶部37にスト
アされる。記憶部37には点Aから点Bまでの間に算出
されたすべての研削偏差Δhiがストアされる。教示点
Aから教示点Bまでの研削作業が終了すると、記憶部3
7に記憶された複数の研削偏差Δhi  (i=1.2
.3・・・)に関して平均化処理部38によりそれらの
平均値Δhを求める。この平均値Δhを用いてバネ定数
演算部33は、次の研削作業工程において押し圧方向(
Z軸方向)に押し圧Fg「を加える時に必要とされる仮
想バネ定数Knを算出する。算出された仮想バネ定数K
nは仮想バネ定数設定部40に与えられ、更にその設定
値によってバネ定数演算部20 8のバネ定数行列にの押し圧方向のバネ定数を変更する
。一方、前記の研削偏差の平均値Δhは終了判定部39
に送給され、その比較判定部41で偏差基準値Hと比較
され、前述した通り次の研削作業を行うか否かが判定さ
れる。研削作業が継続される時には所定の位置目標値が
研削処理演算部43で求められ、この目標値が位置目標
値設定部24に設定される。この作用に基づき通常の位
置・力制御演算部26の機能により、研削工具7は再び
教示点Aの位置に戻り、教示点Bに向かって新たに設定
されたバネ定数Knにより所望の押し圧Fgrをワーク
6に加えながら研削作業を開始する。この研削作業にお
いても前述と同様に、バネ定数演設定部30と終了判定
部39において、研削偏差の平均値の算出、この平均値
に基づく押し圧方向の新たな仮想バネ定数算出、及び研
削作業を終了するべきか否かの判定が行われる。こうし
て研削作業終了と判定されるまで、繰り返し被研削部5
0は研削される。なお、研削作業のための研削工具7の
移動は、教示点AとBとの間を往復させるものであって
も良い。
The obtained grinding deviation Δhi is stored in the storage unit 37, respectively. All the grinding deviations Δhi calculated between point A and point B are stored in the storage unit 37. When the grinding work from teaching point A to teaching point B is completed, the storage unit 3
A plurality of grinding deviations Δhi (i=1.2
.. 3...), the averaging processing unit 38 calculates their average value Δh. Using this average value Δh, the spring constant calculation unit 33 calculates the pressure direction (
Calculate the virtual spring constant Kn required when applying the pressing force Fg' in the Z-axis direction).The calculated virtual spring constant K
n is given to the virtual spring constant setting section 40, and further, the spring constant in the pressing direction in the spring constant matrix of the spring constant calculation section 208 is changed according to the set value. On the other hand, the average value Δh of the grinding deviation is determined by the end determination unit 39
The comparison and determination section 41 compares it with the deviation reference value H, and as described above, it is determined whether or not to perform the next grinding operation. When the grinding operation continues, a predetermined positional target value is determined by the grinding processing calculation section 43, and this target value is set in the positional target value setting section 24. Based on this action, the grinding tool 7 returns to the position of the teaching point A again by the normal function of the position/force control calculation unit 26, and the desired pressing force Fgr is applied toward the teaching point B by the newly set spring constant Kn. The grinding work is started while adding the workpiece 6 to the workpiece 6. In this grinding work, similarly to the above, the spring constant calculation setting section 30 and the end determination section 39 calculate the average value of the grinding deviation, calculate a new virtual spring constant in the pressing direction based on this average value, and perform the grinding work. A determination is made as to whether or not to terminate. In this way, the part to be ground 5 is repeatedly
0 is ground. Note that the movement of the grinding tool 7 for the grinding work may be such that it is moved back and forth between teaching points A and B.

次に第4図に基づいて本発明の第2実施例を説明する。Next, a second embodiment of the present invention will be described based on FIG.

第4図は第2実施例の要部構成を示す。FIG. 4 shows the main structure of the second embodiment.

この実施例では、研削偏差の平均値Δhを求めず、任意
の間隔ごとに研削偏差演算部36で算出された研削偏差
Δhtを基に、その算出のつどバネ定数演算部33で仮
想バネ定数を算出するように構成される。従って、この
実施例では平均化処理部38が省略されており、且つ研
削偏差演算部36で求められた研削偏差Δhiの値は直
接にバネ定数演算部33と記憶部37に与えられる。バ
ネ定数演算部33に続くその後の制御処理については前
記第1の実施例の場合と同じである。記憶部37にスト
アされた各研削偏差Δhjは一連の研削動作が終了した
後、すべてのΔhi  (i=1.2゜3・・・)に対
し比較判定部41で終了判定がなされる。そのとき研削
経路中において1つでもHくΔhiの条件を満たせば、
研削作業を継続すべきであると判定される。これ以後の
制御処理については前記第1実施例の場合と同じである
In this embodiment, the average value Δh of the grinding deviation is not calculated, but the virtual spring constant is calculated in the spring constant calculation unit 33 each time based on the grinding deviation Δht calculated by the grinding deviation calculation unit 36 at arbitrary intervals. configured to calculate. Therefore, in this embodiment, the averaging processing section 38 is omitted, and the value of the grinding deviation Δhi obtained by the grinding deviation calculation section 36 is directly given to the spring constant calculation section 33 and the storage section 37. The subsequent control processing subsequent to the spring constant calculating section 33 is the same as in the first embodiment. For each grinding deviation Δhj stored in the storage unit 37, after a series of grinding operations is completed, a comparison and determination unit 41 determines whether or not all Δhi (i=1.2°3, . . . ) have been completed. At that time, if even one H in the grinding path satisfies the condition of Δhi,
It is determined that the grinding work should be continued. The subsequent control processing is the same as in the first embodiment.

本実施例の構成によれば、任意の距離間隔△lごとに研
削偏差を計測し、これにより押し圧方向の仮想バネ定数
の変更及び設定を短い距離間隔で細かく行うことができ
る。それ故、本実施例では、ワーク6の仕上げ面が不規
則な面であり、研削偏差が不規則に変化するワークに対
して押し圧設窓部32に設定された所望の押し圧を一様
に加えることができるという利点がある。
According to the configuration of this embodiment, the grinding deviation is measured at every arbitrary distance interval Δl, and thereby the virtual spring constant in the pressing direction can be changed and set finely at short distance intervals. Therefore, in this embodiment, the finished surface of the workpiece 6 is an irregular surface, and the desired pressing force set in the pressing window part 32 is uniformly applied to the workpiece whose grinding deviation changes irregularly. It has the advantage that it can be added to

次に第5図に基づいて本発明の第3実施例を説明する。Next, a third embodiment of the present invention will be described based on FIG.

第5図は第3実施例の要部構成を示す。FIG. 5 shows the main structure of the third embodiment.

この実施例では、研削作業の終了又は継続の判定を研削
偏差の値で行わず、力演鼻部22で得られる力情報に基
づいて行うように構成される。研削作業において、研削
工具7からワーク6に与えられる押し圧に対抗するワー
ク6から得られる反力は、力センサ5で検出され、力演
鼻部22で絶対座標系に変換される。この場合において
、研削工具7が仕上げ位置に到達すると、研削すべき量
は0になり、ワーク6から研削工具7に与えられる反力
は発生しない。従って、力センサ5の検出す3 る力を監視していれば研削工具7が仕上げ位置に到達し
たか否かを判断することができる。そこで、力演鼻部2
2の出力する力實を入力する力抽出部60を設け、この
力抽出部60において任意の間隔で力センサ5が検出す
る押し圧方向の力實iを抽出し、この力tiを力判定部
61に供給する。
In this embodiment, the determination of whether to finish or continue the grinding operation is not made based on the value of the grinding deviation, but is made based on the force information obtained from the force acting nose section 22. In the grinding operation, a reaction force obtained from the workpiece 6 that opposes the pressing force applied to the workpiece 6 from the grinding tool 7 is detected by the force sensor 5, and converted into an absolute coordinate system by the force acting nose 22. In this case, when the grinding tool 7 reaches the finishing position, the amount to be ground becomes 0, and no reaction force is generated from the workpiece 6 to the grinding tool 7. Therefore, by monitoring the force detected by the force sensor 5, it is possible to determine whether the grinding tool 7 has reached the finishing position. Therefore, the powerful nose part 2
A force extraction unit 60 is provided which inputs the force actuality outputted by the force sensor 2, and this force extraction unit 60 extracts the force actuality i in the pressing direction detected by the force sensor 5 at arbitrary intervals, and this force ti is sent to the force determination unit. 61.

力判定部61では、力基準値設定部62から与えられる
研削量がOの時の反力値Oとfiを比較し、fiが0を
越える値であれば削り残しがあると判断し、研削処理演
算部43に研削作業を繰り返し継続の信号を送る。fi
が0よりも小さい時には研削作業を終了する信号を研削
処理演算部43に送る。その他の構成・作用については
、位置に基づく終了判定部39を除いて第2図に示され
た実施例と同じである。なお、力基準値設定部62で設
定される反力値は、その他に例えばワークの仕上げ交差
内で生ずる反力の値とすることもできる。
The force determination unit 61 compares fi with the reaction force value O when the amount of grinding given from the force reference value setting unit 62 is O, and if fi is a value exceeding 0, it is determined that there is uncut material, and the grinding is performed. A signal is sent to the processing calculation unit 43 to repeat the grinding operation and continue the grinding operation. fi
When is smaller than 0, a signal to end the grinding operation is sent to the grinding processing calculation section 43. The other configurations and operations are the same as the embodiment shown in FIG. 2, except for the position-based end determination section 39. In addition, the reaction force value set by the force reference value setting section 62 can also be a value of reaction force generated within the finishing intersection of the workpiece, for example.

上記実施例では研削装置に本発明に係る押し圧制御方式
を適用した例を説明したが、被加工部の残量が変化して
も押し圧を所望の一定値にすべく4 仮想バネ定数を変化させる制御方式は、研削装置に類似
するその他の多自由度作業機械に適用することができる
のは勿論である。
In the above embodiment, an example was explained in which the pressing force control method according to the present invention is applied to a grinding device. Of course, the changing control method can be applied to other multi-degree-of-freedom working machines similar to grinding machines.

〔発明の効果〕〔Effect of the invention〕

以上の説明で明らかなように、本発明によれば次のよう
な効果を奏する。
As is clear from the above description, the present invention provides the following effects.

位置・力制御部を有する研削装置において、II+し圧
設窓部とバネ定数演算設定部を備え、研削残量が少なく
なっても、所望の押し圧が得られるように研削偏差から
仮想バネ定数を求めるように構成したため、研削残量の
大小にかかわらず一定の押し圧で研削作業を行うことが
できる。
A grinding device with a position/force control section is equipped with a pressing window section and a spring constant calculation setting section, and the virtual spring constant is calculated from the grinding deviation so that the desired pressing force can be obtained even when the remaining amount of grinding is small. Since it is configured to obtain the amount of grinding remaining, the grinding work can be performed with a constant pressing force regardless of the amount of remaining grinding.

また研削作業が進み研削残量が減少するに従って仮想バ
ネ定数が増加していくため、最終的に位置制御と同等の
剛性を得ることができ、研削作業の能率と仕上げ精度を
高めることができる。
In addition, as the grinding work progresses and the remaining amount of grinding decreases, the virtual spring constant increases, so it is possible to finally obtain the same rigidity as position control, increasing the efficiency and finishing accuracy of the grinding work.

【図面の簡単な説明】[Brief explanation of the drawing]

第1図は本発明が適用される研削装置の構成図、第2図
は押し圧制御装置の具体的構成を示したブロック構成図
、第3図は研削作業の状態を示す作業説明図、第4図は
押し圧制御装置の他の変更実施例を示す要部ブロック構
成図、第5図は押し圧制御装置の他の変更実施例を示す
要部ブロック構成図である。 〔符号の説明〕 1・・・・・・研削装置本体 2・・・・・・アーム 5・・・・・・力センサ 6・・・・・・ワーク 7・・・・・・研削工具 8・・・・・・コントローラ 11・・・・・操作器 22・・・・・力演鼻部 23・・・・・位置演算部 24・・・・・位置目標値設定部 26・・・・・位置・力制御演算部 28・・・・・バネ定数演算部 30・・・・・バネ定数演算設定部 32・・・・・押し圧設窓部 33・・・・・バネ定数演算部 36 ・ 38 ・ 39 ・ 60 ・ 研削偏差演算部 平均化処理部 終了判定部 力抽出部
FIG. 1 is a configuration diagram of a grinding device to which the present invention is applied, FIG. 2 is a block configuration diagram showing a specific configuration of a pressing force control device, FIG. FIG. 4 is a block diagram of main parts showing another modified example of the pressing force control device, and FIG. 5 is a block diagram of main parts showing another modified example of the pressing force control device. [Explanation of symbols] 1... Grinding device main body 2... Arm 5... Force sensor 6... Work 7... Grinding tool 8 ......Controller 11...Manufacturer 22...Force acting nose section 23...Position calculation section 24...Position target value setting section 26...・Position/force control calculation section 28...Spring constant calculation section 30...Spring constant calculation setting section 32...Press pressure setting window section 33...Spring constant calculation section 36・ 38 ・ 39 ・ 60 ・ Grinding deviation calculation section Averaging processing section End judgment section Force extraction section

Claims (4)

【特許請求の範囲】[Claims] (1)研削工具に加わる少なくとも1軸の力を検出する
力検出手段と、前記研削工具の位置を検出する位置検出
手段と、前記力検出手段と前記位置検出手段のそれぞれ
で検出された力と位置のデータを用いて前記研削工具の
位置と力を制御する制御手段とを備え、前記制御手段で
設定される仮想バネ定数でワークに対する研削工具の押
し圧を決定する研削装置において、 研削作業上必要とされる押し圧を設定するための押し圧
設定手段と、前記ワークの仕上げ位置と前記位置検出手
段が出力する前記研削工具の位置データとに基づいて前
記研削工具の移動方向の任意の間隔ごとに研削偏差を求
める研削偏差算出手段と、前記押し圧設定手段の出力値
と前記研削偏差算出手段の出力値に基づき、前記押し圧
が前記押し圧設定手段に設定された設定値となるように
前記仮想バネ定数を算出し、この仮想バネ定数を前記制
御手段に設定するバネ定数演算設定手段とを備えること
を特徴とする押し圧制御式研削装置。
(1) A force detecting means for detecting a force on at least one axis applied to the grinding tool, a position detecting means for detecting the position of the grinding tool, and a force detected by each of the force detecting means and the position detecting means. A grinding device comprising a control means for controlling the position and force of the grinding tool using position data, and determining the pressing force of the grinding tool against the workpiece using a virtual spring constant set by the control means, A pressing force setting means for setting the required pressing force, and an arbitrary interval in the moving direction of the grinding tool based on the finishing position of the workpiece and the position data of the grinding tool outputted by the position detecting means. a grinding deviation calculating means for calculating a grinding deviation for each time, and an output value of the pressing force setting means and an output value of the grinding deviation calculating means so that the pressing force becomes a setting value set in the pressing force setting means. and a spring constant calculation setting means for calculating the virtual spring constant and setting the virtual spring constant in the control means.
(2)請求項1記載の押し圧制御式研削装置において、
前記研削偏差算出手段で算出された研削偏差を取り込み
、この算出された研削偏差と予め設定された偏差基準値
とを比較して研削作業を継続するか又は終了するかを判
定する判定手段を設けたことを特徴とする押し圧制御式
研削装置。
(2) In the pressure-controlled grinding device according to claim 1,
A determining means is provided for taking in the grinding deviation calculated by the grinding deviation calculating means and comparing the calculated grinding deviation with a preset deviation reference value to determine whether to continue or terminate the grinding work. This is a pressure-controlled grinding device that is characterized by:
(3)請求項1記載の押し圧制御式研削装置において、
前記力検出手段の出力する力情報に基づいて研削作業を
継続するか又は終了するかを判定する判定手段を設けた
ことを特徴とする押し圧制御式研削装置。
(3) In the pressure-controlled grinding device according to claim 1,
A pressing force control type grinding device, characterized in that a determining means is provided for determining whether to continue or terminate the grinding work based on the force information outputted by the force detecting means.
(4)請求項1乃至3のいずれかに記載の押し圧制御式
研削装置において、前記研削偏差算出手段は平均化処理
手段を含み、この平均化処理手段で、特定の研削作業区
間について任意の間隔ごとに求められた複数の前記研削
偏差の平均値を求め、この平均値の研削偏差を前記研削
偏差算出手段の出力値としたことを特徴とする押し圧制
御式研削装置。
(4) In the pressing force control type grinding device according to any one of claims 1 to 3, the grinding deviation calculating means includes an averaging processing means, and the averaging processing means performs an arbitrary calculation for a specific grinding work section. A pressing force control type grinding device characterized in that an average value of the plurality of grinding deviations obtained for each interval is obtained, and the grinding deviation of this average value is used as an output value of the grinding deviation calculation means.
JP1280989A 1989-10-27 1989-10-27 Pressing force control grinding machine Expired - Lifetime JPH0651268B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP1280989A JPH0651268B2 (en) 1989-10-27 1989-10-27 Pressing force control grinding machine

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP1280989A JPH0651268B2 (en) 1989-10-27 1989-10-27 Pressing force control grinding machine

Publications (2)

Publication Number Publication Date
JPH03142159A true JPH03142159A (en) 1991-06-17
JPH0651268B2 JPH0651268B2 (en) 1994-07-06

Family

ID=17632707

Family Applications (1)

Application Number Title Priority Date Filing Date
JP1280989A Expired - Lifetime JPH0651268B2 (en) 1989-10-27 1989-10-27 Pressing force control grinding machine

Country Status (1)

Country Link
JP (1) JPH0651268B2 (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5711697A (en) * 1994-06-17 1998-01-27 Komatsu Ltd. Robot control system
GB2352417A (en) * 1999-03-25 2001-01-31 Ford Global Tech Inc Robotic sander for vehicle bodies
CN103522159A (en) * 2013-10-14 2014-01-22 陈功 Automatic polishing method with constant force and equipment with same
KR20170098184A (en) * 2016-02-19 2017-08-29 가부시키가이샤 에바라 세이사꾸쇼 Polishing apparatus and polishing method
EP2740568A3 (en) * 2012-12-04 2018-04-11 General Electric Company Automated polishing systems and methods
WO2023013560A1 (en) * 2021-08-03 2023-02-09 川崎重工業株式会社 Robot system, robotic processing method, and processing program

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5711697A (en) * 1994-06-17 1998-01-27 Komatsu Ltd. Robot control system
US6021361A (en) * 1994-06-17 2000-02-01 Komatsu, Ltd. Robot control system
GB2352417A (en) * 1999-03-25 2001-01-31 Ford Global Tech Inc Robotic sander for vehicle bodies
GB2352417B (en) * 1999-03-25 2003-09-17 Ford Global Tech Inc Method and tooling for automated wet or dry sanding of a vehicle surface
EP2740568A3 (en) * 2012-12-04 2018-04-11 General Electric Company Automated polishing systems and methods
CN103522159A (en) * 2013-10-14 2014-01-22 陈功 Automatic polishing method with constant force and equipment with same
KR20170098184A (en) * 2016-02-19 2017-08-29 가부시키가이샤 에바라 세이사꾸쇼 Polishing apparatus and polishing method
JP2020142368A (en) * 2016-02-19 2020-09-10 株式会社荏原製作所 Polishing apparatus
US11331769B2 (en) 2016-02-19 2022-05-17 Ebara Corporation Polishing apparatus and polishing method
TWI784943B (en) * 2016-02-19 2022-12-01 日商荏原製作所股份有限公司 Polishing apparatus
WO2023013560A1 (en) * 2021-08-03 2023-02-09 川崎重工業株式会社 Robot system, robotic processing method, and processing program

Also Published As

Publication number Publication date
JPH0651268B2 (en) 1994-07-06

Similar Documents

Publication Publication Date Title
CN105458878B (en) Robot system for performing force control
EP0584843B1 (en) Device controlling the machining force of a tool
EP0421323B1 (en) Grinder robot
WO1998053376A1 (en) Method and apparatus for the direct teaching of automatic machines
CN110394802B (en) Polishing robot and position compensation method
JP2000198047A (en) Machine tool
JPH07205022A (en) Correcting method for grinding wheel wear in force control robot
JPH03142159A (en) Push pressure control type grinding device
CN111624940B (en) Information processing apparatus and information processing method
US20230138649A1 (en) Following robot
JPS6027809A (en) Method for measuring shape of surface
JP2927148B2 (en) Grinding robot
JP2911211B2 (en) Robot controller
JPH03270865A (en) Position and force control device for working machine with multiple degree of freedom
JP2669075B2 (en) Direct teaching device and position teaching method for robot position and posture
JPH106180A (en) Work machining device
JP2641315B2 (en) Grinding equipment
JPH05329787A (en) Work position detecting device for force control robot
JPH07195287A (en) Contact type position transducer of force control robot
JPH03149171A (en) Tool locus control device for industrial robot
JPH05301157A (en) Grinding robot
JPH09267282A (en) Work object position detector of multiarticulated robot
JP2868195B2 (en) Grinding robot and grinding work execution method
JPH09141582A (en) Contact position detecting device for force control robot
JP2023090137A (en) Processing system and processing method