JP5500995B2 - 力検出装置 - Google Patents
力検出装置 Download PDFInfo
- Publication number
- JP5500995B2 JP5500995B2 JP2010001143A JP2010001143A JP5500995B2 JP 5500995 B2 JP5500995 B2 JP 5500995B2 JP 2010001143 A JP2010001143 A JP 2010001143A JP 2010001143 A JP2010001143 A JP 2010001143A JP 5500995 B2 JP5500995 B2 JP 5500995B2
- Authority
- JP
- Japan
- Prior art keywords
- actuator
- force
- unit
- acceleration
- comparator
- 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.)
- Active
Links
Images
Landscapes
- Force Measurement Appropriate To Specific Purposes (AREA)
Description
また、特許文献2に開示される力センサからの信号に基づきアクチュエータを制御する方法では、力センサが高価であり、破損し易い等の課題がある。
実施の形態1.
図1はこの発明の実施の形態1に係る力検出装置の構成を示す図である。
力検出装置は、アクチュエータ可動部1aに設置されたワークやハンドが対象物と接触した際にアクチュエータ可動部1aに加わる接触力を推定するものである。この力検出装置は、図1に示すように、アクチュエータ1、位置センサ2、第1比較器3、位相補償回路4、定電流ドライバ(電流発生部)5及び外力推定部6Aから構成される。
なお、アクチュエータ可動部1aに加えられる外力には、ワークやハンドが対象物と接触することにより生じる接触力の他に、アクチュエータ可動部1aに加わる重力加速度により生じる力及びアクチュエータ1の移動加速度により生じる力が含まれている。
アクチュエータ1は、入力電圧に比例した電流を発生する定電流ドライバ5からの電流がボイスコイルモータに流れることにより駆動力を発生してアクチュエータ可動部1aを上下に移送する。
外力推定部6Aは、図2に示すように、第1〜3演算部11〜13、第1,2LPF(Low Pass Filter)14,15、サンプルホールド回路16及び第2〜4比較器17〜19から構成される。
なお、外力推定部6Aは、ノイズの影響を受け難くするために、特許文献3に開示される外乱オブザーバのように純粋微分系を含まない形で構成されるものであるが、実施の形態1における外力推定部6Aでは、原理説明のため簡略化して説明を行う。
この第1演算部11により、定電流ドライバ5から供給された電流によりアクチュエータ1が発生する駆動力が推定される。
第3演算部13は、第2演算部12により算出されたアクチュエータ可動部1aの速度の値に質量Mとラプラス演算子sを乗算するものであり、その出力はアクチュエータ1が発生する駆動力から、アクチュエータ可動部1aに加わる接触力とアクチュエータ可動部1aに加わる重力加速度および移動加速度により受ける力の加算値を差し引いた推定値となる。この第3演算部13により算出された値を示す信号は第2LPF15及び第3比較器18に供給される。
第2LPF15は、第3演算部13から供給された信号から高域ノイズを除去するための低域ゲインが0dBのフィルタである。この第2LPF15により高域ノイズが除去された信号は第2比較器17に供給される。
従って、この第4比較器19によりアクチュエータ可動部1aに加わる接触力とアクチュエータ可動部1aに加わる移動加速度により受ける力の加算値が推定され、アクチュエータ可動部1aが停止もしくは一定速度で移動している場合には接触力が推定される。
アクチュエータ可動部1aに加えられる外力には、ワークやハンドが対象物と接触することにより生じる接触力の他に、アクチュエータ可動部1aに加わる重力加速度により生じる力及びアクチュエータ1の移動加速度により生じる力が含まれている。
そのため、まず、図3に示すように、ワークやハンドが対象物に接触していない状態でアクチュエータ可動部1aが停止しており、かつアクチュエータ1全体も移送されていない状態でアクチュエータ可動部1aに加わる外力を推定することで、アクチュエータ可動部1aに加わる重力加速度により生じる力を推定する(ステップST31)。
このように、ワークやハンドが対象物に接触していない状態でアクチュエータ可動部1aが停止しており、かつアクチュエータ1全体も移送されていない状態において、外力推定部6Aによりアクチュエータ可動部1aに加わる外力を推定することで、アクチュエータ可動部1aに加わる重力加速度により生じる力を推定することができる。
まず、第1演算部11は、定電流ドライバ5に入力した電圧に対して演算を行い、アクチュエータ1が発生する駆動力を推定する。この第1演算部11により推定された値を示す信号は第3比較器18に供給される。
図4はこの発明の実施の形態2に係る力検出装置の構成を示す図である。
図4に示す実施の形態2に係る力検出装置は、図1に示す実施の形態1に係る力検出装置に加速度センサ7を追加し、外力推定部6Aを外力推定部6Bに変更したものである。
図5に示す実施の形態2における外力推定部6Bは、図2に示す実施の形態1における外力推定部6Aから第1,2LPF14,15、サンプルホールド回路16及び第2比較器17を削除し、第3LPF20及び第4演算部21を追加したものである。その他の構成は、図2に示す実施の形態1における外力推定部6Aと同様であり、同一の符号を付し、その説明を省略する。
この第4演算部21によりアクチュエータ可動部1aに加わる加速度により生じる力がノイズが除去された状態で推定される。
まず、第1演算部11は、定電流ドライバ5に入力する電圧eに対して演算を行い、アクチュエータ1が発生する駆動力を推定する。この第1演算部11により推定された駆動力を示す信号は第3比較器18に供給される。
この第2演算部12及び第3演算部13により推定された値を示す信号は第3比較器18に供給される。
1a アクチュエータ可動部
2 位置センサ
3,17〜19 第1〜4比較器
4 位相補償回路
5 定電流ドライバ(電流発生部)
6A,6B 外力推定部
7 加速度センサ
11〜13,21 第1〜4演算部
14,15,20 第1〜3LPF
16 サンプルホールド回路
Claims (1)
- 入力電圧に比例した電流を発生する電流発生部と、
前記電流発生部により発生された電流に応じた駆動力を発生し可動部を移送するアクチュエータと、
前記可動部の位置を検出する位置センサの出力と目標位置を比較してその誤差を前記電流発生部を通して前記アクチュエータにフィードバックすることにより位置決め制御を行う装置であって、
前記電流発生部に入力する電圧及び前記位置センサにより検出された位置に基づいて、前記可動部が対象物に非接触、かつ、停止している状態で前記可動部に加わる重力加速度による力を推定した後に、前記アクチュエータを停止、もしくは一定速度で移送している状態で推定した前記可動部に加わる外力から前記重力加速度による力を差し引いて、前記可動部に加わる接触力を推定する外力推定部と
を備える力検出装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010001143A JP5500995B2 (ja) | 2010-01-06 | 2010-01-06 | 力検出装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010001143A JP5500995B2 (ja) | 2010-01-06 | 2010-01-06 | 力検出装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2011141157A JP2011141157A (ja) | 2011-07-21 |
JP5500995B2 true JP5500995B2 (ja) | 2014-05-21 |
Family
ID=44457115
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2010001143A Active JP5500995B2 (ja) | 2010-01-06 | 2010-01-06 | 力検出装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5500995B2 (ja) |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6052296A (ja) * | 1983-09-02 | 1985-03-25 | 株式会社日立製作所 | 力センサ出力の修正方法 |
JPH08140398A (ja) * | 1994-11-10 | 1996-05-31 | Canon Inc | モータ制御装置 |
JPH1158285A (ja) * | 1997-08-14 | 1999-03-02 | Sumitomo Heavy Ind Ltd | ハンド機構の力制御システム |
JP2009045687A (ja) * | 2007-08-20 | 2009-03-05 | Ntn Corp | 把持装置の把持制御装置 |
JP5284683B2 (ja) * | 2008-05-08 | 2013-09-11 | アズビル株式会社 | 精密位置決め装置 |
-
2010
- 2010-01-06 JP JP2010001143A patent/JP5500995B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2011141157A (ja) | 2011-07-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5209810B1 (ja) | イナーシャと摩擦係数とばね定数を同時に推定する機能を備える電動機の制御装置 | |
EP3150341B1 (en) | Robot control device | |
JP3796261B1 (ja) | モータの負荷イナーシャ推定方法 | |
Birjandi et al. | Model-adaptive high-speed collision detection for serial-chain robot manipulators | |
TW201238233A (en) | Motor control device and motor control method | |
JP2019181610A (ja) | モータエンコーダ及びセンサを用いて学習制御を行うロボットシステム | |
JP6238869B2 (ja) | 接触制御装置 | |
JP2006215626A (ja) | 位置制御装置 | |
JP2008091856A (ja) | 電子部品搭載装置 | |
JP4487073B2 (ja) | 外力推定方法および外力推定装置 | |
JP2006293624A (ja) | 多軸制御装置 | |
US8415913B2 (en) | Control circuit and control method for motor | |
JP5500995B2 (ja) | 力検出装置 | |
JP2000330642A (ja) | ステージの位置制御装置及び速度制御装置 | |
JP5284683B2 (ja) | 精密位置決め装置 | |
JP2018192535A (ja) | 部品嵌合方法及び部品嵌合装置 | |
Wasilewski et al. | Autocalibration of gyroscope based two-step regulator for autonomous vehicles. | |
JP2010022132A (ja) | 慣性モーメント同定器を備えたモータ制御装置 | |
JP4329438B2 (ja) | 電動機制御装置 | |
JP6711536B2 (ja) | 外力検出方法 | |
JP6923273B2 (ja) | はんだ付け装置 | |
JP2010022138A (ja) | モータ制御装置 | |
Yoshioka et al. | Variable noise-covariance Kalman filter based instantaneous state observer for industrial robot | |
JP6912149B2 (ja) | 接着装置 | |
JP4507071B2 (ja) | モータ制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20120921 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20131128 |
|
A131 | Notification of reasons for refusal |
Effective date: 20131203 Free format text: JAPANESE INTERMEDIATE CODE: A131 |
|
A521 | Written amendment |
Effective date: 20140117 Free format text: JAPANESE INTERMEDIATE CODE: A523 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20140212 |
|
A61 | First payment of annual fees (during grant procedure) |
Effective date: 20140311 Free format text: JAPANESE INTERMEDIATE CODE: A61 |
|
R150 | Certificate of patent (=grant) or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Country of ref document: JP Ref document number: 5500995 |