JP5977983B2 - Mass measuring device - Google Patents

Mass measuring device Download PDF

Info

Publication number
JP5977983B2
JP5977983B2 JP2012084461A JP2012084461A JP5977983B2 JP 5977983 B2 JP5977983 B2 JP 5977983B2 JP 2012084461 A JP2012084461 A JP 2012084461A JP 2012084461 A JP2012084461 A JP 2012084461A JP 5977983 B2 JP5977983 B2 JP 5977983B2
Authority
JP
Japan
Prior art keywords
article
force
acceleration
mass
points
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
Application number
JP2012084461A
Other languages
Japanese (ja)
Other versions
JP2013213749A (en
Inventor
誠 中谷
誠 中谷
亮民 鈴木
亮民 鈴木
小西 聡
聡 小西
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Ishida Co Ltd
Original Assignee
Ishida 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 Ishida Co Ltd filed Critical Ishida Co Ltd
Priority to JP2012084461A priority Critical patent/JP5977983B2/en
Priority to PCT/JP2012/073856 priority patent/WO2013042667A1/en
Priority to US14/345,723 priority patent/US9140598B2/en
Priority to CN201280045411.1A priority patent/CN103814279B/en
Priority to EP12834227.6A priority patent/EP2759815B1/en
Publication of JP2013213749A publication Critical patent/JP2013213749A/en
Application granted granted Critical
Publication of JP5977983B2 publication Critical patent/JP5977983B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Description

本発明は、質量測定装置に関し、特に移動している物品の質量をその移動時に測定する質量測定装置に関する。   The present invention relates to a mass measuring device, and more particularly to a mass measuring device that measures the mass of a moving article during movement.

一般に、ばね秤や電子秤では、重力加速度以外の加速度の影響を排除するために、静止状態で使用することを前提としている。しかし、近年、揺れる物体上に据え付けられ、揺動による計量誤差を除去した質量を測定する質量測定装置が普及している。例えば、特許文献1(特開平8−110261号公報)に開示されている質量測定装置では、通常の計量センサとしての計量用ロードセルとは別に、分銅を載荷したダミー用ロードセルで床の上下動成分を検出し、検出した上下動成分を、計量用ロードセルの出力信号から減算することによって、床の上下動成分を含まない測定信号を出力するようにしている。   In general, spring balances and electronic balances are assumed to be used in a stationary state in order to eliminate the influence of acceleration other than gravitational acceleration. However, in recent years, mass measuring apparatuses that are installed on a swinging object and measure a mass from which a weighing error due to the swinging is removed have become widespread. For example, in the mass measuring device disclosed in Patent Document 1 (Japanese Patent Application Laid-Open No. Hei 8-110261), a vertical load component of a floor using a dummy load cell loaded with a weight separately from a weighing load cell as a normal weighing sensor. Is detected, and the detected vertical movement component is subtracted from the output signal of the weighing load cell to output a measurement signal that does not include the vertical movement component of the floor.

しかしながら、上記特許文献1に記載の質量測定装置も、物品に作用する重力によってロードセルが垂直方向へ変位することを利用しているので、ロードセルが重力によっては、変位しない状態になる場合、物品の質量を検出することができなくなる。   However, since the mass measuring device described in Patent Document 1 also uses the fact that the load cell is displaced in the vertical direction due to gravity acting on the article, when the load cell is not displaced by gravity, The mass cannot be detected.

それゆえ、例えば、マニピュレータやロボットハンドのように、物品を持ち上げて移動させる先端部にロードセルを取り付けて、持ち上げた物品を移動している最中に、その物品の質量を測定しようとしても、従来技術では困難である。   Therefore, for example, when a load cell is attached to a tip part that lifts and moves an article, such as a manipulator or a robot hand, and the mass of the article is measured while the lifted article is moving, It is difficult with technology.

そこで、出願人は、物品を移動させ、その際に物品に作用する力および加速度から物品の質量を算出する質量測定装置を開発した。開発段階では、水平に移動する物品に作用する加速度を測定することによって、物品に作用する重力加速度の影響を排除しようとしたが、力センサが傾いて取り付けられた場合、物品に作用する重力のうちの力センサの傾き方向の分力が、力センサの出力に現れることが判明した。   Therefore, the applicant has developed a mass measuring device that moves the article and calculates the mass of the article from the force and acceleration acting on the article. In the development stage, we tried to eliminate the effect of gravity acceleration acting on the article by measuring the acceleration acting on the horizontally moving article, but when the force sensor is mounted tilted, the gravity acting on the article It was found that the component force in the tilt direction of our force sensor appears in the output of the force sensor.

本発明の課題は、力センサの出力に含まれる重力の分力を除去することができる質量測定装置を提供することにある。   The subject of this invention is providing the mass measuring device which can remove the component of gravity contained in the output of a force sensor.

本発明の第1観点に係る質量測定装置は、物品を移動させ、その際に物品に作用する力および加速度から物品の質量を算出する質量測定装置であって、保持機構と、移動機構と、力測定部と、加速度測定部と、制御部とを備えている。保持機構は、物品を保持する。移動機構は、保持機構を移動させる。力測定部は、保持機構と移動機構との間に設けられて、移動時の物品に作用する力を測定する。加速度測定部は、移動時の物品に作用する加速度を測定する。制御部は、保持機構および移動機構を運転制御し、移動時の物品に作用する力および加速度に基づいて物品の質量を算出する。また、制御部は、力測定部で得られる2点の力測定値の差と、力測定部に連動して加速度測定部で得られる2点の加速度測定値の差とを用いて物品の質量を算出する。また、力測定部で得られる2点は、ともに極値点である。 A mass measuring apparatus according to a first aspect of the present invention is a mass measuring apparatus that moves an article and calculates the mass of the article from the force and acceleration acting on the article, and includes a holding mechanism, a moving mechanism, A force measurement unit, an acceleration measurement unit, and a control unit are provided. The holding mechanism holds the article. The moving mechanism moves the holding mechanism. The force measuring unit is provided between the holding mechanism and the moving mechanism, and measures the force acting on the article during movement. The acceleration measuring unit measures acceleration acting on the article during movement. The control unit controls the operation of the holding mechanism and the moving mechanism, and calculates the mass of the article based on the force and acceleration acting on the article during movement. In addition, the control unit uses the difference between the two force measurement values obtained at the force measurement unit and the difference between the two acceleration measurement values obtained at the acceleration measurement unit in conjunction with the force measurement unit. Is calculated. Further, the two points obtained by the force measuring unit are both extreme points.

力測定部がロードセルであるような場合、その取り付け角度が僅かに傾くことによって、ロードセルの傾き方向に重力が影響し、基準点出力がばらつくことになる。しかし、この質量測定装置では、力測定部から得られるデータの2点の差、及び加速度測定部から得られるデータの2点の差を用いるので基準点出力を必要としない。その結果、質量測定時に基準点出力のばらつきの影響、つまり、重力の影響が排除される。   When the force measuring unit is a load cell, the mounting angle is slightly inclined, so that gravity affects the inclination direction of the load cell and the reference point output varies. However, in this mass measuring device, since a difference between two points of data obtained from the force measuring unit and a difference between two points of data obtained from the acceleration measuring unit is used, no reference point output is required. As a result, the influence of variations in reference point output during mass measurement, that is, the influence of gravity is eliminated.

また、この質量測定装置では、力測定部の出力の極値点に対応する加速度測定部の出力の極値点は特定し易く、位相差の影響を受け難い。  Further, in this mass measuring apparatus, the extreme point of the output of the acceleration measuring unit corresponding to the extreme point of the output of the force measuring unit can be easily specified and is not easily affected by the phase difference.

本発明の第2観点に係る質量測定装置は、物品を移動させ、その際に物品に作用する力および加速度から物品の質量を算出する質量測定装置であって、保持機構と、移動機構と、力測定部と、加速度測定部と、制御部とを備えている。保持機構は、物品を保持する。移動機構は、保持機構を移動させる。力測定部は、保持機構と移動機構との間に設けられて、移動時の物品に作用する力を測定する。加速度測定部は、移動時の物品に作用する加速度を測定する。制御部は、保持機構および移動機構を運転制御し、移動時の物品に作用する力および加速度に基づいて物品の質量を算出する。また、制御部は、力測定部で得られる2点の力測定値の差と、力測定部に連動して加速度測定部で得られる2点の加速度測定値の差とを用いて物品の質量を算出する。また、力測定部で得られる2点は、最大値点および最小値点である。 A mass measuring apparatus according to a second aspect of the present invention is a mass measuring apparatus that moves an article and calculates the mass of the article from the force and acceleration acting on the article, and includes a holding mechanism, a moving mechanism, A force measurement unit, an acceleration measurement unit, and a control unit are provided. The holding mechanism holds the article. The moving mechanism moves the holding mechanism. The force measuring unit is provided between the holding mechanism and the moving mechanism, and measures the force acting on the article during movement. The acceleration measuring unit measures acceleration acting on the article during movement. The control unit controls the operation of the holding mechanism and the moving mechanism, and calculates the mass of the article based on the force and acceleration acting on the article during movement. In addition, the control unit uses the difference between the two force measurement values obtained at the force measurement unit and the difference between the two acceleration measurement values obtained at the acceleration measurement unit in conjunction with the force measurement unit. Is calculated. Further, the two points obtained by the force measuring unit are a maximum value point and a minimum value point.

この質量測定装置では、雑音量Nが一定とした場合、信号量Sが大きいほど信号量に対する雑音量(誤差量)の割合が減少する。本項では、信号量S=[最大値―最小値]>[他の任意の2点の差]であり、他のどの2点を取るよりも誤差の割合が小さくなるので、質量算出の精度が向上する In this mass measuring apparatus, when the noise amount N is constant, the ratio of the noise amount (error amount) to the signal amount decreases as the signal amount S increases. In this section, the signal amount S = [maximum value−minimum value]> [difference between any two other points], and the error rate is smaller than taking any other two points. Will improve .

本発明の第観点に係る質量測定装置は、物品を移動させ、その際に物品に作用する力および加速度から物品の質量を算出する質量測定装置であって、保持機構と、移動機構と、力測定部と、加速度測定部と、制御部とを備えている。保持機構は、物品を保持する。移動機構は、保持機構を移動させる。力測定部は、保持機構と移動機構との間に設けられて、移動時の物品に作用する力を測定する。加速度測定部は、移動時の物品に作用する加速度を測定する。制御部は、保持機構および移動機構を運転制御し、移動時の物品に作用する力および加速度に基づいて物品の質量を算出する。また、制御部は、加速度測定部で得られる2点の加速度測定値の差と、加速度測定部に連動して力測定部で得られる2点の力測定値の差とを用いて物品の質量を算出する。また、加速度測定部で得られる2点は、ともに極値点である。 A mass measuring apparatus according to a third aspect of the present invention is a mass measuring apparatus that moves an article and calculates the mass of the article from the force and acceleration acting on the article, and includes a holding mechanism, a moving mechanism, A force measurement unit, an acceleration measurement unit, and a control unit are provided. The holding mechanism holds the article. The moving mechanism moves the holding mechanism. The force measuring unit is provided between the holding mechanism and the moving mechanism, and measures the force acting on the article during movement. The acceleration measuring unit measures acceleration acting on the article during movement. The control unit controls the operation of the holding mechanism and the moving mechanism, and calculates the mass of the article based on the force and acceleration acting on the article during movement. Further, the control unit uses the difference between the two acceleration measurement values obtained by the acceleration measurement unit and the difference between the two force measurement values obtained by the force measurement unit in conjunction with the acceleration measurement unit. Is calculated. The two points obtained by the acceleration measuring unit are both extreme points.

加速度測定部がロードセルであるような場合、その取り付け角度が僅かに傾くことによって、ロードセルの傾き方向に重力が影響し、基準点出力がばらつくことになる。しかし、この質量測定装置では、加速度測定部から得られるデータの2点の差、及び力測定部から得られるデータの2点の差を用いるので基準点出力を必要としない。その結果、質量測定時に基準点出力のばらつきの影響、つまり、重力の影響が排除される。また、加速度測定部の出力の極値点は特定し易く、位相差の影響を受け難い。 When the acceleration measuring unit is a load cell, the mounting angle is slightly inclined, so that gravity affects the inclination direction of the load cell and the reference point output varies. However, in this mass measuring device, since a difference between two points of data obtained from the acceleration measuring unit and a difference between two points of data obtained from the force measuring unit is used, no reference point output is required. As a result, the influence of variations in reference point output during mass measurement, that is, the influence of gravity is eliminated. Moreover, the extreme point of the output of the acceleration measuring unit is easy to specify and is not easily affected by the phase difference.

本発明の第観点に係る質量測定装置は、物品を移動させ、その際に物品に作用する力および加速度から物品の質量を算出する質量測定装置であって、保持機構と、移動機構と、力測定部と、加速度測定部と、制御部とを備えている。保持機構は、物品を保持する。移動機構は、保持機構を移動させる。力測定部は、保持機構と移動機構との間に設けられて、移動時の物品に作用する力を測定する。加速度測定部は、移動時の物品に作用する加速度を測定する。制御部は、保持機構および移動機構を運転制御し、移動時の物品に作用する力および加速度に基づいて物品の質量を算出する。また、制御部は、加速度測定部で得られる2点の加速度測定値の差と、加速度測定部に連動して力測定部で得られる2点の力測定値の差とを用いて物品の質量を算出する。また、加速度測定部で得られる2点は、最大値点および最小値点である。 A mass measuring device according to a fourth aspect of the present invention is a mass measuring device that moves an article and calculates the mass of the article from the force and acceleration acting on the article at that time, and includes a holding mechanism, a moving mechanism, A force measurement unit, an acceleration measurement unit, and a control unit are provided. The holding mechanism holds the article. The moving mechanism moves the holding mechanism. The force measuring unit is provided between the holding mechanism and the moving mechanism, and measures the force acting on the article during movement. The acceleration measuring unit measures acceleration acting on the article during movement. The control unit controls the operation of the holding mechanism and the moving mechanism, and calculates the mass of the article based on the force and acceleration acting on the article during movement. Further, the control unit uses the difference between the two acceleration measurement values obtained by the acceleration measurement unit and the difference between the two force measurement values obtained by the force measurement unit in conjunction with the acceleration measurement unit. Is calculated. The two points obtained by the acceleration measuring unit are the maximum value point and the minimum value point.

この質量測定装置では、他のどの2点を取るよりも誤差の割合が小さくなるので、質量算出の精度が向上する。  In this mass measuring apparatus, since the error rate is smaller than any other two points, the accuracy of mass calculation is improved.

本発明に係る質量測定装置では、力測定部から得られるデータの2点の差、及び加速度測定部から得られるデータの2点の差を用いるので基準点出力を必要としない。その結果、質量測定時に基準点出力のばらつきの影響、つまり、重力の影響が排除される。   In the mass measuring device according to the present invention, since a difference between two points of data obtained from the force measuring unit and a difference between two points of data obtained from the acceleration measuring unit is used, no reference point output is required. As a result, the influence of variations in reference point output during mass measurement, that is, the influence of gravity is eliminated.

本発明の一実施形態に係る質量測定装置の概略構成図。1 is a schematic configuration diagram of a mass measuring device according to an embodiment of the present invention. 図1の質量測定装置をばね−質量系で表わしたときの当該質量測定装置の2自由度モデル。2 is a two-degree-of-freedom model of the mass measuring device when the mass measuring device of FIG. 1 is represented by a spring-mass system. 零点調整のために、吸着部に何も保持させない状態で力センサおよび加速度センサから得られた検出信号を示すグラフ。The graph which shows the detection signal obtained from the force sensor and the acceleration sensor in the state which does not hold | maintain anything at an adsorption | suction part for zero point adjustment. スパン調整用の既知の分銅を吸着部に保持させた状態で力センサおよび加速度センサから得られた検出信号を示すグラフ。The graph which shows the detection signal obtained from the force sensor and the acceleration sensor in the state which made the adsorption | suction part hold | maintain the known weight for span adjustment. 質量mの被測定物を吸着部に保持させた状態で力センサおよび加速度センサから得られた検出信号を示すグラフ。The graph which shows the detection signal obtained from the force sensor and the acceleration sensor in the state which hold | maintained the to-be-measured object of mass m in the adsorption | suction part. 質量測定装置の制御系のブロック図。The block diagram of the control system of a mass measuring device. 力センサおよび加速度センサによって検出された信号を処理する信号処理回路図。The signal processing circuit diagram which processes the signal detected by the force sensor and the acceleration sensor. 力センサが水平に対して角度θだけ傾いた状態で取り付けられたときの重力の分力方向を表す説明図。Explanatory drawing showing the force component direction of gravity when a force sensor is attached in the state inclined only angle (theta) with respect to the horizontal. 水平に対して角度θだけ傾いた状態で取り付けられた力センサから得られた検出信号を示すグラフ。The graph which shows the detection signal obtained from the force sensor attached in the state inclined only angle (theta) with respect to the horizontal. 力センサおよび加速度センサから得られた検出信号の任意の2点を示すグラフ。The graph which shows two arbitrary points of the detection signal obtained from the force sensor and the acceleration sensor. 力センサの第1の出力パターンを示すグラフ。The graph which shows the 1st output pattern of a force sensor. 力センサの第2の出力パターンを示すグラフ。The graph which shows the 2nd output pattern of a force sensor. 力センサの第3の出力パターンを示すグラフ。The graph which shows the 3rd output pattern of a force sensor. 力センサの第4の出力パターンを示すグラフ。The graph which shows the 4th output pattern of a force sensor.

以下図面を参照しながら、本発明の実施形態について説明する。なお、以下の実施形態は、本発明の具体例であって、本発明の技術的範囲を限定するものではない。   Embodiments of the present invention will be described below with reference to the drawings. The following embodiments are specific examples of the present invention and do not limit the technical scope of the present invention.

(1)質量測定装置100の構成
図1は、本発明の一実施形態に係る質量測定装置100の概略構成図である。図1において、質量測定装置100は、力センサ1と、吸着部2と、ロボットアーム3と、加速度センサ4とを備えている。
(1) Configuration of Mass Measuring Device 100 FIG. 1 is a schematic configuration diagram of a mass measuring device 100 according to an embodiment of the present invention. In FIG. 1, the mass measuring apparatus 100 includes a force sensor 1, a suction unit 2, a robot arm 3, and an acceleration sensor 4.

力センサ1は移動中の物品Qに作用する力を検出する。また、力センサ1には、例えば、歪みゲージ式ロードセルが採用される。歪みゲージ式ロードセルは、移動によって自由端側が固定端側に対して相対的に変位し、それによって自由端側に作用する力を検出することができる。   The force sensor 1 detects a force acting on the moving article Q. Further, for example, a strain gauge type load cell is employed for the force sensor 1. The strain gauge load cell can detect a force acting on the free end side by moving the free end side relative to the fixed end side by movement.

吸着部2は、物品Qを保持する。また、吸着部2には、エアー吸着機構、或いは、エアーチャック機構が採用される。なお、吸着部2は、エアー吸着機構やエアーチャック機構などに限定されるものではなく、モータ駆動のフィンガー機構であってもよい。   The adsorption unit 2 holds the article Q. Further, an air suction mechanism or an air chuck mechanism is employed for the suction portion 2. The suction unit 2 is not limited to an air suction mechanism or an air chuck mechanism, but may be a motor-driven finger mechanism.

ロボットアーム3は、吸着部2を3次元的に移動させる。また、ロボットアーム3は、所定の回転軸CAを中心にしてCW方向およびCCW方向に回転することもできる。なお、ロボットアーム3としては、例えば、水平多関節ロボットや垂直多関節ロボット、あるいは、パラレルリンクロボット等が適切である。   The robot arm 3 moves the suction unit 2 three-dimensionally. The robot arm 3 can also rotate in the CW direction and the CCW direction about a predetermined rotation axis CA. As the robot arm 3, for example, a horizontal articulated robot, a vertical articulated robot, or a parallel link robot is suitable.

加速度センサ4は、物品Qに作用する加速度を検出する。また、加速度センサ4としては、例えば、歪みゲージ式ロードセル、MEMS型の小型加速度センサ、及び一般的な市販の加速度センサのいずれかが適宜採用される。   The acceleration sensor 4 detects acceleration acting on the article Q. As the acceleration sensor 4, for example, any one of a strain gauge type load cell, a MEMS type small acceleration sensor, and a general commercially available acceleration sensor is appropriately employed.

なお、力センサ1は吸着部2とロボットアーム3との間に設けられ、加速度センサ4は吸着部2に隣接するように設けられる。以下で説明する実施形態では、力センサ1及び加速度センサ4ともに歪みゲージ式ロードセルが採用され、力センサ1及び加速度センサ4は水平方向に移動する物品Qに作用する力と加速度を検出する。   The force sensor 1 is provided between the adsorption unit 2 and the robot arm 3, and the acceleration sensor 4 is provided adjacent to the adsorption unit 2. In the embodiment described below, strain gauge type load cells are employed for both the force sensor 1 and the acceleration sensor 4, and the force sensor 1 and the acceleration sensor 4 detect the force and acceleration acting on the article Q moving in the horizontal direction.

(2)質量測定の原理
図2は、図1の質量測定装置100をばね−質量系で表わしたときの当該質量測定装置の2自由度モデルである。
(2) Principle of Mass Measurement FIG. 2 is a two-degree-of-freedom model of the mass measuring device when the mass measuring device 100 of FIG. 1 is represented by a spring-mass system.

図2において、mは物品Qの質量、M1は力センサ1の自由端側の質量と吸着部2の質量および加速度センサ4の固定端側の質量の和、M2は加速度センサ4の自由端の質量である。また、k1は力センサ1のばね定数、k2は加速度センサ4のばね定数である。x1は力センサ1の変位量、x2は加速度センサ4の変位量とする。 In FIG. 2, m is the mass of the article Q, M 1 is the sum of the mass of the fixed end side of the force sensor 1 for mass and the suction portion 2 of the free end mass and the acceleration sensor 4, M 2 is free of the acceleration sensor 4 It is the mass of the end. K 1 is the spring constant of the force sensor 1, and k 2 is the spring constant of the acceleration sensor 4. x 1 is the displacement amount of the force sensor 1, and x 2 is the displacement amount of the acceleration sensor 4.

物品Qに加速度が作用したときの運動方程式は、
(m+M1)d21/dt2=−k1(x1−y)+k2(x1−x2) (1)
222/dt2=−k2(x2−x1) (2)
として表される。また(1)式を変形すると、
m=[−k1(x1−y)+k2(x1−x2)]/(d21/dt2)−M1 (3)
となる。さらに、加速度センサ4の剛性が大きいことを考慮すると、
21/dt2≒d22/dt2 (4)
として近似できる。それゆえ、(3)及び(4)式より、
m=[−k1(x1−y)+k2(x1−x2)]/(d22/dt2)−M1 (5)
が導き出される。また、(2)式を変形すると、
22/dt2=−k2(x2−x1)/M2 (6)
となるので、(5)、(6)式より、
m=[−k1(x1−y)/−k2(x2−x1)]M2+M2−M1 (7)
が導き出される。
The equation of motion when acceleration acts on the article Q is
(M + M 1 ) d 2 x 1 / dt 2 = −k 1 (x 1 −y) + k 2 (x 1 −x 2 ) (1)
M 2 d 2 x 2 / dt 2 = −k 2 (x 2 −x 1 ) (2)
Represented as: Moreover, when the equation (1) is transformed,
m = [− k 1 (x 1 −y) + k 2 (x 1 −x 2 )] / (d 2 x 1 / dt 2 ) −M 1 (3)
It becomes. Furthermore, considering that the rigidity of the acceleration sensor 4 is large,
d 2 x 1 / dt 2 ≈d 2 x 2 / dt 2 (4)
Can be approximated as Therefore, from equations (3) and (4)
m = [− k 1 (x 1 −y) + k 2 (x 1 −x 2 )] / (d 2 x 2 / dt 2 ) −M 1 (5)
Is derived. Moreover, when the equation (2) is transformed,
d 2 x 2 / dt 2 = −k 2 (x 2 −x 1 ) / M 2 (6)
Therefore, from equations (5) and (6),
m = [− k 1 (x 1 −y) / − k 2 (x 2 −x 1 )] M 2 + M 2 −M 1 (7)
Is derived.

ここで、−k1(x1−y)は力センサ1の出力、−k2(x2−x1)は加速度センサ4の出力である。 Here, −k 1 (x 1 −y) is an output of the force sensor 1, and −k 2 (x 2 −x 1 ) is an output of the acceleration sensor 4.

図3は、零点調整のために、吸着部2に何も保持させない状態で力センサ1及び加速度センサ4から得られた検出信号を示すグラフである。図3において、力センサ1の出力のピーク値をFmz、加速度センサ4の出力のピーク値をFazとしたとき、(7)式より、
0=M2・C・(Fmz/Faz)+M2−M1 (8)
となる。但し、加速度は0でない場合を想定している。なお、Cは換算係数である。
FIG. 3 is a graph showing detection signals obtained from the force sensor 1 and the acceleration sensor 4 in a state where nothing is held by the suction unit 2 for zero point adjustment. In FIG. 3, when the peak value of the output of the force sensor 1 is Fmz and the peak value of the output of the acceleration sensor 4 is Faz,
0 = M 2 · C · (Fmz / Faz) + M 2 −M 1 (8)
It becomes. However, it is assumed that the acceleration is not zero. C is a conversion coefficient.

図4は、スパン調整用の既知の分銅を吸着部2に保持させた状態で力センサ1及び加速度センサ4から得られた検出信号を示すグラフである。図4において、スパン質量をms、力センサ1の出力のピーク値をFms、加速度センサ4の出力のピーク値をFasとしたとき、(7)式より、
ms=M2・C・(Fms/Fas)+M2−M1 (9)
となる。そして、(8)−(9)式より、
C=ms/M2{(Fms/Fas)−(Fmz/Faz)} (10)
が導き出される。(10)式より、M2は固定係数として、スパン係数をSとすると、
S=C・M2=ms/{(Fms/Fas)−(Fmz/Faz)} (11)
である。
FIG. 4 is a graph showing detection signals obtained from the force sensor 1 and the acceleration sensor 4 in a state where a known weight for span adjustment is held in the suction portion 2. In FIG. 4, when the span mass is ms, the peak value of the output of the force sensor 1 is Fms, and the peak value of the output of the acceleration sensor 4 is Fas,
ms = M 2 · C · (Fms / Fas) + M 2 −M 1 (9)
It becomes. And from the equations (8)-(9),
C = ms / M 2 {(Fms / Fas) − (Fmz / Faz)} (10)
Is derived. From equation (10), if M 2 is a fixed coefficient and the span coefficient is S,
S = C · M 2 = ms / {(Fms / Fas) − (Fmz / Faz)} (11)
It is.

図5は、質量mの被測定物を吸着部に保持させた状態で力センサ1及び加速度センサ4から得られた検出信号を示すグラフである。図5において、力センサ1の出力のピーク値をFm、加速度センサ4の出力のピーク値をFaとしたとき、(11)式より、
m=S{(Fm/Fa)−(Fmz/Faz)} (12)
となる。
FIG. 5 is a graph showing detection signals obtained from the force sensor 1 and the acceleration sensor 4 in a state where an object to be measured having a mass m is held by the suction portion. In FIG. 5, when the peak value of the output of the force sensor 1 is Fm and the peak value of the output of the acceleration sensor 4 is Fa,
m = S {(Fm / Fa)-(Fmz / Faz)} (12)
It becomes.

(3)制御系
図6は、質量測定装置100の制御系のブロック図である。図6において、制御部40及び記憶部49を含む制御回路50には、力センサ1、吸着部2、ロボットアーム3、加速度センサ4、入力部7及びディスプレイ8が電気的に接続されている。なお、力センサ1、吸着部2、ロボットアーム3、及び加速度センサ4については、既に説明しているので、ここでは言及しない。
(3) Control System FIG. 6 is a block diagram of a control system of the mass measuring apparatus 100. In FIG. 6, a force sensor 1, a suction unit 2, a robot arm 3, an acceleration sensor 4, an input unit 7, and a display 8 are electrically connected to a control circuit 50 including a control unit 40 and a storage unit 49. Since the force sensor 1, the suction unit 2, the robot arm 3, and the acceleration sensor 4 have already been described, they are not mentioned here.

入力部7は、質量測定装置100の始動前に、オペレータが力センサ1の定格や、被測定物の測定範囲などを入力するための機器であり、具体的には、キーボード、或いは、タッチパネルである。   The input unit 7 is a device for an operator to input the rating of the force sensor 1 and the measurement range of the object to be measured before starting the mass measuring device 100. Specifically, the input unit 7 is a keyboard or a touch panel. is there.

ディスプレイ8は、質量測定装置100の動作状況を逐次表示するための機器であり、力センサ1及び加速度センサ4の異常や、吸着部2及びロボットアーム3の動作異常が発生したときには、エラー表示を行う。   The display 8 is a device for sequentially displaying the operation status of the mass measuring apparatus 100. When an abnormality occurs in the force sensor 1 and the acceleration sensor 4 or an operation abnormality occurs in the suction unit 2 and the robot arm 3, an error display is displayed. Do.

記憶部49は、質量測定装置100に搭載可能な力センサ1の定格、及び被測定物の質量範囲ごとに設定された被測定物に作用させるべき適用加速度を予め記憶している。   The storage unit 49 stores in advance the rating of the force sensor 1 that can be mounted on the mass measuring device 100 and the applied acceleration to be applied to the measurement object set for each mass range of the measurement object.

例えば、質量測定装置100が、物品Qが搬送される工程で、「吸着部2によって物品Qを吸着し、ロボットアーム3によって物品Qを梱包容器まで移動させ、その間に質量を測定し、物品Qを梱包容器に納める」という動作を行う場合、オペレータは質量測定装置100の始動前に、物品Qの質量測定範囲(例えば、m±0.5g)を入力する。   For example, when the mass measuring apparatus 100 is a process in which the article Q is transported, “the article Q is adsorbed by the adsorbing unit 2, the article Q is moved to the packing container by the robot arm 3, and the mass is measured in the meantime. In the case of performing the operation of “storing the product in the packaging container”, the operator inputs the mass measurement range (for example, m ± 0.5 g) of the article Q before the mass measurement apparatus 100 is started.

記憶部49は、予め質量m程度の物品Qの質量を測定するときに物品Qに作用させるべき最適加速度を記憶している。制御部40は、入力された質量測定範囲に対応する適用加速度を記憶部49から読み取り、ロボットアーム3を介して物品Qにその適用加速度を作用させ、そのときの力センサ1の出力を読み取る。なお、制御部40としては、DSP(ディジタル・シグナル・プロセッサ)やマイコン等が採用される。   The storage unit 49 stores in advance the optimum acceleration to be applied to the article Q when measuring the mass of the article Q having a mass of about m. The control unit 40 reads the applied acceleration corresponding to the input mass measurement range from the storage unit 49, causes the applied acceleration to act on the article Q via the robot arm 3, and reads the output of the force sensor 1 at that time. As the control unit 40, a DSP (digital signal processor), a microcomputer, or the like is employed.

図7は、力センサ1及び加速度センサ4によって検出された信号を処理する信号処理回路図である。図7において、力センサ1と加速度センサ4には、それぞれ増幅器31a、31bが接続されており、これらの増幅器31a、31bは、力センサ1及び加速度センサ4から入力された検出信号を増幅する。また、増幅器31a、31bには、それぞれA/D変換器33a、33bが接続されている。そのA/D変換器33a、33bは、入力されたアナログ信号をディジタル信号に変換する。   FIG. 7 is a signal processing circuit diagram for processing signals detected by the force sensor 1 and the acceleration sensor 4. In FIG. 7, amplifiers 31 a and 31 b are connected to the force sensor 1 and the acceleration sensor 4, respectively, and these amplifiers 31 a and 31 b amplify detection signals input from the force sensor 1 and the acceleration sensor 4. In addition, A / D converters 33a and 33b are connected to the amplifiers 31a and 31b, respectively. The A / D converters 33a and 33b convert the input analog signal into a digital signal.

A/D変換器33a、33bには、それぞれローパスフィルタ37a、37bが接続されている。このローパスフィルタ37a、37bは、入力された検出信号から一定周波数以上のノイズ成分を除去する。また、ローパスフィルタ37a、37bは、制御部40に接続されている。   Low-pass filters 37a and 37b are connected to the A / D converters 33a and 33b, respectively. The low-pass filters 37a and 37b remove noise components of a certain frequency or more from the input detection signal. The low pass filters 37 a and 37 b are connected to the control unit 40.

制御部40は、入力された検出信号に基づいて各種の処理を実行する。先ず、制御部40は、力センサ1及び加速度センサ4の検出信号に含まれるノイズ周波数成分をローパスフィルタ37a、37bにより除去する処理を行う。そして、そのノイズ周波数成分が除去された力センサ1の検出信号を除算器41により加速度センサ4の検出信号で除算する処理を行い、その後、制御部40は、減算器43として機能することで、その除算結果を用いて式(12)の演算を行い、質量mを算出する処理を行う。即ち、制御部40は、力センサ1及び加速度センサ4の検出信号に基づいて、物品Qの質量mを算出する。   The control unit 40 executes various processes based on the input detection signal. First, the control unit 40 performs processing for removing noise frequency components included in the detection signals of the force sensor 1 and the acceleration sensor 4 by the low-pass filters 37a and 37b. And the process which divides the detection signal of the force sensor 1 from which the noise frequency component was removed by the detection signal of the acceleration sensor 4 by the divider 41, and then the control unit 40 functions as the subtractor 43, The calculation of equation (12) is performed using the division result, and the process of calculating the mass m is performed. That is, the control unit 40 calculates the mass m of the article Q based on the detection signals of the force sensor 1 and the acceleration sensor 4.

(4)物品Qに作用する重力の影響
上記の質量測定の原理で説明した力センサ1は感度方向が水平に取り付けられているので、水平移動時の出力に重力の影響は現れない。しかしながら、力センサ1の感度方向を厳密に水平に取り付けることは容易ではなく、ある程度傾いた状態で取り付けられる。
(4) Influence of Gravity Acting on Article Q Since the force sensor 1 described in the principle of mass measurement is attached in the direction of sensitivity, the influence of gravity does not appear in the output during horizontal movement. However, it is not easy to attach the sensitivity direction of the force sensor 1 strictly horizontally, and the force sensor 1 is attached in a tilted state to some extent.

図8は、力センサ1が水平に対して角度θだけ傾いた状態で取り付けられたときの重力の分力方向を表す説明図である。また、図9Aは、水平に対して角度θだけ傾いた状態で取り付けられた力センサ1から得られた検出信号を示すグラフである。   FIG. 8 is an explanatory diagram showing the direction of the force component of gravity when the force sensor 1 is attached with an angle θ with respect to the horizontal. FIG. 9A is a graph showing a detection signal obtained from the force sensor 1 attached in a state inclined by an angle θ with respect to the horizontal.

図8及び図9Aにおいて、力センサ1は水平に対して角度θだけ傾いているので、吸着部2が質量mの物品Qを保持した際に、力センサ1の出力に物品Qに作用する重力の分力(mg・sinθ)が現れる。その結果、図9Aに示すように、吸着部2が物品Qを保持せず水平移動したときの力センサ1から得られる出力に対して、物品Qを保持して水平移動したときの力センサ1から得られる出力は基準点がmg・sinθだけマイナス方向に変化する。   8 and 9A, since the force sensor 1 is inclined by an angle θ with respect to the horizontal, the gravity acting on the article Q on the output of the force sensor 1 when the suction unit 2 holds the article Q having the mass m. Force (mg · sinθ) appears. As a result, as shown in FIG. 9A, the force sensor 1 when the suction unit 2 moves horizontally while holding the article Q with respect to the output obtained from the force sensor 1 when moving horizontally without holding the article Q. The reference point of the output obtained from is changed in the minus direction by mg · sin θ.

例えば、物品Qの質量mが力センサ1の出力のピーク値を加速度センサ4の出力のピーク値で除算して算出される場合には、基準点から視た力センサ1の出力のピーク値は重力の分力(mg・sinθ)を含んでいるので、物品Qの質量mが正確に測定されない。   For example, when the mass m of the article Q is calculated by dividing the peak value of the output of the force sensor 1 by the peak value of the output of the acceleration sensor 4, the peak value of the output of the force sensor 1 viewed from the reference point is Since the gravitational force (mg · sin θ) is included, the mass m of the article Q is not accurately measured.

(5)物品Qに作用する重力の影響を排除する手段
前述の(12)式では、力センサ1の出力のピーク値Fmと加速度センサ4の出力のピーク値Faとの出力比[Fm/Fa]から質量mを算出したが、(12)式の[Fm/Fa]の部分は、力センサ1の任意の2点における出力値の差と、連動する加速度センサ4の2点における出力値の差との比率であっても成り立つ。以下、その根拠を説明する。
(5) Means for Eliminating the Effect of Gravity Acting on the Article Q In the above equation (12), the output ratio [Fm / Fa between the peak value Fm of the output of the force sensor 1 and the peak value Fa of the output of the acceleration sensor 4 The mass m is calculated from the equation [12], and the portion of [Fm / Fa] in the equation (12) is the difference between the output value at any two points of the force sensor 1 and the output value at two points of the interlocking acceleration sensor 4. Even a ratio with the difference holds. Hereinafter, the basis will be described.

図9Bは、力センサ1及び加速度センサ4から得られた検出信号の任意の2点を示すグラフである。すなわち、図9Bに示す任意の2点K、Jにおいても、(12)式は成立する。図9Bに示すように2点K、Jの力センサ1の出力をそれぞれFmk、Fmjとし、その力センサ1に連動して得られる加速度センサ4の出力をそれぞれFak、Fajとする。2点K、Jにおいても(12)式は成り立つので、力センサ1の出力値と、連動する加速度センサ4の出力値の比率をMとすると、
Fmk/Fak=Fmj/Faj=M (13)
が成り立ち、(13)式を変形すると、
M・Fak=Fmk (14)
M・Faj=Fmj (15)
となる。そして、(14)−(15)式より
M・(Fak−Faj)=Fmk−Fmj (16)
(16)式を変形すると
M=(Fmk−Fmj)/(Fak−Faj) (17)
したがって、(12)式の[Fm/Fa]の部分は、力センサ1の任意の2点における出力値の差と、連動する加速度センサ4の2点における出力値の差の比率であってもよい。
FIG. 9B is a graph showing arbitrary two points of the detection signals obtained from the force sensor 1 and the acceleration sensor 4. That is, the equation (12) is also established at any two points K and J shown in FIG. 9B. As shown in FIG. 9B, the outputs of the force sensor 1 at two points K and J are Fmk and Fmj, respectively, and the outputs of the acceleration sensor 4 obtained in conjunction with the force sensor 1 are Fak and Faj, respectively. Since the equation (12) is also established at two points K and J, if the ratio of the output value of the force sensor 1 and the output value of the interlocking acceleration sensor 4 is M,
Fmk / Fak = Fmj / Faj = M (13)
When the equation (13) is transformed,
M ・ Fak = Fmk (14)
M ・ Faj = Fmj (15)
It becomes. And from the equation (14)-(15): M · (Fak−Faj) = Fmk−Fmj (16)
When the equation (16) is transformed, M = (Fmk−Fmj) / (Fak−Faj) (17)
Therefore, the part of [Fm / Fa] in the equation (12) is the ratio of the difference between the output values at any two points of the force sensor 1 and the difference between the output values at the two points of the interlocking acceleration sensor 4. Good.

例えば、力センサ1の任意の2点K、Jにおける出力値が重力の分力を含んでいる場合の値をFmkg、Fmjgとすると、重力の分力を含んでいない場合の出力値は図9BにおけるFmk,Fmjであるので、Fmkg=Fmk+mg・sinθ、Fmjg=Fmj+mg・sinθ、となる。   For example, assuming that the output values at the arbitrary two points K and J of the force sensor 1 include gravitational force components as Fmkg and Fmjg, the output values when the gravitational force components are not included are shown in FIG. 9B. Therefore, Fmkg = Fmk + mg · sin θ, and Fmjg = Fmj + mg · sin θ.

また、Fmkg−Fmjg=Fmk+mg・sinθ−(Fmj+mg・sinθ)であるので、mg・sinθは相殺され、Fmkg−Fmjg=Fmk−Fmjとなる。つまり、力センサ1の出力値に重力の分力(mg・sinθ)が含まれていても、力センサ1から得られる出力の2点の差を用いることによって、基準点出力を求めなくても質量を算出することができる。   Further, since Fmkg−Fmjg = Fmk + mg · sin θ− (Fmj + mg · sin θ), mg · sin θ is canceled and Fmkg−Fmjg = Fmk−Fmj. In other words, even if the output value of the force sensor 1 includes a gravitational force component (mg · sin θ), it is not necessary to obtain the reference point output by using the difference between the two points of the output obtained from the force sensor 1. Mass can be calculated.

但し、出力の値が接近した2点では、信号量に対する誤差量の割合が増加して、質量算出の精度を低下させる懸念がある。そこで、考え得る力センサ1の出力パターンを想定し、その出力パターン毎に最適な2点を選択することが好ましい。以下、各出力パターンの最適な2点について説明する。   However, at two points where the output values are close, there is a concern that the ratio of the error amount to the signal amount increases and the accuracy of mass calculation decreases. Therefore, it is preferable to assume two possible output patterns of the force sensor 1 and to select two optimal points for each output pattern. Hereinafter, two optimal points of each output pattern will be described.

(5−1)時間に対する変化率の小さい2点
図10は、力センサ1の第1の出力パターンを示すグラフである。図10において、B1点及びB2点は共に時間に対する力の変化率が小さい点である。力センサ1と加速度センサ4との間には位相差があるので、精度良く質量を算出するためには位相差分を補償しなければならないが、位相差は常に一定ではないので、完全な補償は困難である。
(5-1) Two Points with a Small Rate of Change with Time FIG. 10 is a graph showing a first output pattern of the force sensor 1. In FIG. 10, points B 1 and B 2 are both points where the rate of change of force with respect to time is small. Since there is a phase difference between the force sensor 1 and the acceleration sensor 4, the phase difference must be compensated in order to accurately calculate the mass, but the phase difference is not always constant. Have difficulty.

しかし、時間に対する力の変化率が小さい2点であれば、補償しきれない位相差があっても測定データの経時的変化量が小さい分だけ誤差が小さくなる。したがって、位相差の影響を受け難い。   However, if the rate of change of force with respect to time is small, even if there is a phase difference that cannot be compensated for, the error is reduced by the amount of change over time of the measured data. Therefore, it is difficult to be affected by the phase difference.

なお、変化率が小さい2点として、力センサ1で得られる出力の微分値がゼロに近い点が優先的に選択されるが、力センサ1で得られる出力のうち絶対値が大きく、且つ、微分値が小さい点がより好ましい。   Note that, as the two points having a small change rate, a point where the differential value of the output obtained by the force sensor 1 is close to zero is preferentially selected, but the absolute value of the output obtained by the force sensor 1 is large, and A point with a small differential value is more preferable.

(5−2)2つの極値点
図11は、力センサ1の第2の出力パターンを示すグラフである。図11において、D1点及びD2点は極値点である。極値点を選択するメリットは、力センサ1の出力の極値点に対応する加速度センサ4の出力の極値点が特定し易いことである。なぜなら、力センサ1と加速度センサ4との間にある位相差は数μs〜数msであるので、その差内に複数の極値点が存在することは確率的に極めて小さい。それゆえ、力センサ1の出力の極値点に対応する加速度センサ4の出力の極値点は特定し易い。したがって、位相差の影響を受け難い。
(5-2) Two Extreme Value Points FIG. 11 is a graph showing a second output pattern of the force sensor 1. In FIG. 11, points D 1 and D 2 are extreme points. The merit of selecting the extreme point is that it is easy to specify the extreme point of the output of the acceleration sensor 4 corresponding to the extreme point of the output of the force sensor 1. This is because the phase difference between the force sensor 1 and the acceleration sensor 4 is several μs to several ms, and the existence of a plurality of extreme points within the difference is very small probabilistically. Therefore, the extreme point of the output of the acceleration sensor 4 corresponding to the extreme point of the output of the force sensor 1 is easy to specify. Therefore, it is difficult to be affected by the phase difference.

(5−3)最小値点と最大値点
図12は、力センサ1の第3の出力パターンを示すグラフである。図12において、E1点とE2点とは、最小値点と最大値点とである。最小値点と最大値点とを選択するメリットは、S/N比が大きくなり、質量算出の精度が向上することである。
(5-3) Minimum Value Point and Maximum Value Point FIG. 12 is a graph showing a third output pattern of the force sensor 1. In FIG. 12, points E 1 and E 2 are a minimum value point and a maximum value point. The merit of selecting the minimum value point and the maximum value point is that the S / N ratio is increased and the accuracy of mass calculation is improved.

雑音量Nが一定である場合、信号量Sが大きいほど信号量に対する雑音量(誤差量)の割合が減少する。ここでは、信号量S=[最大値―最小値]>[他の任意の2点の差]であり、他のどの2点を取るよりも誤差量の割合が小さくなる、すなわち、S/N比が大きくなる。したがって、質量算出の精度が向上する。   When the noise amount N is constant, the ratio of the noise amount (error amount) to the signal amount decreases as the signal amount S increases. Here, the signal amount S = [maximum value−minimum value]> [difference between two other arbitrary points], and the ratio of the error amount is smaller than any other two points, that is, S / N. The ratio increases. Therefore, the accuracy of mass calculation is improved.

(5−4)測定値の差が所定値以上となる2点
図13は、力センサ1の第4の出力パターンを示すグラフである。図13において、H1点とH2点とは、測定値の差が所定値以上となる2点である。測定値の差が所定値以上となる2点を選択するメリットは、S/N比が大きくなり、質量算出の精度が向上することである。
(5-4) Two points at which the difference between measured values is equal to or greater than a predetermined value FIG. 13 is a graph showing a fourth output pattern of the force sensor 1. In FIG. 13, points H 1 and H 2 are two points where the difference between measured values is equal to or greater than a predetermined value. The merit of selecting two points where the difference between the measured values is equal to or greater than a predetermined value is that the S / N ratio is increased and the accuracy of mass calculation is improved.

上段で述べたように、雑音量Nが一定である場合、信号量Sが大きいほど信号量に対する雑音量(誤差量)の割合が減少するので、S/N比が大きくなる。H1点とH2点とは、測定値の差が所定値以上となる2点であるので、信号量Sは所定値以上になる。所定値を雑音量(誤差量)Nに対して十分に大きく設定すればS/N比が大きくなる。したがって、質量算出の精度が向上する。 As described above, when the noise amount N is constant, the ratio of the noise amount (error amount) to the signal amount decreases as the signal amount S increases, so the S / N ratio increases. Since the H 1 point and the H 2 point are two points where the difference between the measured values is equal to or greater than a predetermined value, the signal amount S is equal to or greater than the predetermined value. If the predetermined value is set sufficiently larger than the noise amount (error amount) N, the S / N ratio increases. Therefore, the accuracy of mass calculation is improved.

(6)特徴
(6−1)
質量測定装置100では、制御部40が力センサ1で得られる2点の力測定値の差と、力センサ1に連動して加速度センサ4で得られる2点の加速度測定値の差とを用いて物品Qの質量を算出するので、力センサ1及び加速度センサ4の基準点出力を必要としない。その結果、質量測定時に基準点出力のばらつきの影響、つまり、重力の影響が排除されるので、質量算出の精度が向上する。
(6) Features (6-1)
In the mass measuring apparatus 100, the control unit 40 uses a difference between two force measurement values obtained by the force sensor 1 and a difference between two acceleration measurement values obtained by the acceleration sensor 4 in conjunction with the force sensor 1. Since the mass of the article Q is calculated, the reference point outputs of the force sensor 1 and the acceleration sensor 4 are not required. As a result, the influence of variations in reference point output during mass measurement, that is, the influence of gravity is eliminated, so that the accuracy of mass calculation is improved.

(6−2)
質量測定装置100では、力センサ1で得られる2点を時間に対する変化率が小さい2点とすることによって、力センサ1および加速度センサ4それぞれの出力に位相差が発生していても、その位相差の影響を小さくできる。
(6-2)
In the mass measuring apparatus 100, even if a phase difference occurs between the outputs of the force sensor 1 and the acceleration sensor 4 by setting the two points obtained by the force sensor 1 to two points having a small change rate with respect to time, it is possible to The influence of the phase difference can be reduced.

(6−3)
質量測定装置100では、力センサ1で得られる2点をともに極値点とすることによって、力センサ1の出力の極値点に対応する加速度センサ4の出力の極値点が特定し易くなるので、位相差の影響を受け難い。
(6-3)
In the mass measuring apparatus 100, the extreme points of the output of the acceleration sensor 4 corresponding to the extreme points of the output of the force sensor 1 can be easily specified by using the two points obtained by the force sensor 1 as extreme points. Therefore, it is hard to be influenced by the phase difference.

(6−4)
質量測定装置100では、力センサ1で得られる2点を最大値点および最小値点とすることによって、信号量S=[最大値―最小値]>[他の任意の2点の差]となり、雑音量(誤差量)Nが一定である場合、他のどの2点を取るよりも誤差量の割合が小さく、S/N比が大きくなるので、質量算出の精度が向上する。
(6-4)
In the mass measuring apparatus 100, the signal amount S = [maximum value−minimum value]> [difference between two other arbitrary points] by setting the two points obtained by the force sensor 1 as the maximum value point and the minimum value point. When the noise amount (error amount) N is constant, since the ratio of the error amount is smaller and the S / N ratio is larger than any other two points, the accuracy of mass calculation is improved.

(6−5)
質量測定装置100では、力センサ1で得られる2点を力測定値の差が所定値以上となる2点とすることによって、信号量Sが所定値以上となる。所定値を雑音量(誤差量)Nに対して十分に大きく設定すればS/N比が大きくなり、その分、質量算出の精度が向上する。
(6-5)
In the mass measuring apparatus 100, the signal amount S becomes equal to or greater than the predetermined value by setting the two points obtained by the force sensor 1 to be two points where the difference between the force measurement values is equal to or greater than the predetermined value. If the predetermined value is set sufficiently larger than the noise amount (error amount) N, the S / N ratio increases, and the accuracy of mass calculation is improved accordingly.

(7)変形例
上記実施形態では、制御部40が力センサ1で得られる2点の力測定値の差と、力センサ1に連動して加速度センサ4で得られる2点の加速度測定値の差とを用いて物品Qの質量を算出しているが、これに限定されるものではない。
(7) Modification In the above embodiment, the control unit 40 calculates the difference between the two force measurement values obtained by the force sensor 1 and the two acceleration measurement values obtained by the acceleration sensor 4 in conjunction with the force sensor 1. Although the mass of the article Q is calculated using the difference, the present invention is not limited to this.

この変形例に係る質量測定装置100では、制御部40が加速度センサ4で得られる2点の加速度測定値の差と、加速度センサ4に連動して力センサ1で得られる2点の力測定値の差とを用いて物品Qの質量を算出する。   In the mass measuring apparatus 100 according to this modification, the control unit 40 obtains the difference between the two acceleration measurement values obtained by the acceleration sensor 4 and the two force measurement values obtained by the force sensor 1 in conjunction with the acceleration sensor 4. Is used to calculate the mass of the article Q.

したがって、上記実施形態と同様、力センサ1の出力値に重力の分力(mg・sinθ)が含まれていても、加速度センサ4から得られる出力の2点の差、及び力センサ1から得られる出力の2点の差を用いることによって、基準点出力を求めなくても質量を算出することができる。   Therefore, as in the above embodiment, even if the output value of the force sensor 1 includes the gravitational force component (mg · sin θ), the difference between the two points of the output obtained from the acceleration sensor 4 and the force sensor 1 By using the difference between the two output points, the mass can be calculated without obtaining the reference point output.

また、上記実施形態と同様、出力の値が接近した2点では、信号量に対する誤差量の割合が増加して、質量算出の精度を低下させる懸念があるので、この変形例についても、考え得る加速度センサ4の出力パターンを想定し、その出力パターン毎に最適な2点を選択することが好ましい。以下、各出力パターンの最適な2点について説明する。   Similarly to the above embodiment, at two points where the output values are close to each other, there is a concern that the ratio of the error amount to the signal amount increases and the accuracy of mass calculation decreases, so this modification can also be considered. Assuming an output pattern of the acceleration sensor 4, it is preferable to select two optimal points for each output pattern. Hereinafter, two optimal points of each output pattern will be described.

(7−1)時間に対する変化率の小さい2点
変形例に係る質量測定装置100では、加速度センサ4で得られる2点は、時間に対する変化率が小さい2点である。時間に対する加速度の変化率が小さい2点であれば、補償しきれない位相差があっても測定データの経時的変化量が小さい分だけ誤差が小さくなる。したがって、位相差の影響を受け難い。
(7-1) Two points with a small change rate with respect to time In the mass measuring apparatus 100 according to the modification, two points obtained by the acceleration sensor 4 are two points with a small change rate with respect to time. If the rate of change of acceleration with respect to time is small, even if there is a phase difference that cannot be compensated for, the error is reduced by the amount of change over time of the measured data. Therefore, it is difficult to be affected by the phase difference.

なお、変化率が小さい2点として、加速度センサ4で得られる出力の微分値がゼロに近い点が優先的に選択されるが、加速度センサ4で得られる出力のうち絶対値が大きく、且つ、微分値が小さい点がより好ましい。   Note that, as the two points having a small change rate, a point where the differential value of the output obtained by the acceleration sensor 4 is close to zero is preferentially selected, but the absolute value of the output obtained by the acceleration sensor 4 is large, and A point with a small differential value is more preferable.

(7−2)2つの極値点
変形例に係る質量測定装置100では、加速度センサ4で得られる2点は、極値点である。加速度センサ4と力センサ1との間にある位相差は数μs〜数msであるので、その差内に複数の極値点が存在することは確率的に極めて小さい。それゆえ、加速度センサ4の出力の極値点に対応する力センサ1の出力の極値点は特定し易い。したがって、位相差の影響を受け難い。
(7-2) Two extreme points In the mass measuring device 100 according to the modification, the two points obtained by the acceleration sensor 4 are extreme points. Since the phase difference between the acceleration sensor 4 and the force sensor 1 is several μs to several ms, the existence of a plurality of extreme points within the difference is very small stochastically. Therefore, it is easy to specify the extreme point of the output of the force sensor 1 corresponding to the extreme point of the output of the acceleration sensor 4. Therefore, it is difficult to be affected by the phase difference.

(7−3)最小値点と最大値点
変形例に係る質量測定装置100では、加速度センサ4で得られる2点は、最小値点と最大値点である。雑音量Nが一定である場合、信号量Sが大きいほど信号量に対する雑音量(誤差量)の割合が減少する。ここでは、信号量S=[最大値―最小値]>[他の任意の2点の差]であり、他のどの2点を取るよりも誤差量の割合が小さくなる、すなわち、S/N比が大きくなる。したがって、質量算出の精度が向上する。
(7-3) Minimum Value Point and Maximum Value Point In the mass measuring device 100 according to the modification, the two points obtained by the acceleration sensor 4 are the minimum value point and the maximum value point. When the noise amount N is constant, the ratio of the noise amount (error amount) to the signal amount decreases as the signal amount S increases. Here, the signal amount S = [maximum value−minimum value]> [difference between two other arbitrary points], and the ratio of the error amount is smaller than any other two points, that is, S / N. The ratio increases. Therefore, the accuracy of mass calculation is improved.

(7−4)測定値の差が所定値以上となる2点
変形例に係る質量測定装置100では、加速度センサ4で得られる2点は、測定値の差が所定値以上となる2点である。上段で述べたように、雑音量Nが一定である場合、信号量Sが大きいほど信号量に対する雑音量(誤差量)の割合が減少するので、S/N比が大きくなる。測定値の差が所定値以上となる2点では、信号量Sは所定値以上になる。所定値を雑音量(誤差量)Nに対して十分に大きく設定すればS/N比が大きくなる。したがって、質量算出の精度が向上する。
(7-4) Two points where the difference between measured values is equal to or greater than a predetermined value In the mass measuring apparatus 100 according to the modification, two points obtained by the acceleration sensor 4 are two points where the difference between measured values is equal to or greater than a predetermined value. is there. As described above, when the noise amount N is constant, the ratio of the noise amount (error amount) to the signal amount decreases as the signal amount S increases, so the S / N ratio increases. At two points where the difference between measured values is equal to or greater than a predetermined value, the signal amount S is equal to or greater than a predetermined value. If the predetermined value is set sufficiently larger than the noise amount (error amount) N, the S / N ratio increases. Therefore, the accuracy of mass calculation is improved.

以上にように、本願発明によれば、物品を移動させながらその物品の質量を測定することができるので、アセンブリ製品の内部部品の欠品検査にも有用である。   As described above, according to the present invention, since the mass of an article can be measured while the article is moved, the present invention is also useful for a shortage inspection of internal parts of an assembly product.

1 力センサ(力測定部)
2 吸着部(保持機構)
3 ロボットアーム(移動機構)
4 加速度センサ(加速度測定部)
40 制御部
Q 物品(被計量物)
1 Force sensor (force measuring unit)
2 Adsorption part (holding mechanism)
3 Robot arm (movement mechanism)
4 Acceleration sensor (acceleration measurement unit)
40 Control part Q Goods (objects to be weighed)

特開平8−110261号公報JP-A-8-110261

Claims (4)

物品を移動させ、その際に前記物品に作用する力および加速度から前記物品の質量を算出する質量測定装置であって、
前記物品を保持する保持機構と、
前記保持機構を移動させる移動機構と、
前記保持機構と前記移動機構との間に設けられて、移動時の前記物品に作用する力を測定する力測定部と、
移動時の前記物品に作用する加速度を測定する加速度測定部と、
前記保持機構および前記移動機構を運転制御し、移動時の前記物品に作用する力および加速度に基づいて前記物品の質量を算出する制御部と、
を備え、
前記制御部は、
前記力測定部で得られる2点の力測定値の差と、
前記力測定部に連動して前記加速度測定部で得られる2点の加速度測定値の差と、
を用いて前記物品の質量を算出し、
前記力測定部で得られる2点は、ともに極値点である、
質量測定装置。
A mass measuring device that moves the article and calculates the mass of the article from the force and acceleration acting on the article at that time,
A holding mechanism for holding the article;
A moving mechanism for moving the holding mechanism;
A force measuring unit that is provided between the holding mechanism and the moving mechanism and measures a force acting on the article during movement;
An acceleration measuring unit for measuring acceleration acting on the article during movement;
A controller that controls the operation of the holding mechanism and the moving mechanism, and calculates the mass of the article based on the force and acceleration acting on the article during movement;
With
The controller is
A difference between two force measurement values obtained by the force measurement unit;
A difference between two acceleration measurement values obtained by the acceleration measurement unit in conjunction with the force measurement unit;
To calculate the mass of the article ,
The two points obtained by the force measuring unit are both extreme points.
Mass measuring device.
物品を移動させ、その際に前記物品に作用する力および加速度から前記物品の質量を算出する質量測定装置であって、
前記物品を保持する保持機構と、
前記保持機構を移動させる移動機構と、
前記保持機構と前記移動機構との間に設けられて、移動時の前記物品に作用する力を測定する力測定部と、
移動時の前記物品に作用する加速度を測定する加速度測定部と、
前記保持機構および前記移動機構を運転制御し、移動時の前記物品に作用する力および加速度に基づいて前記物品の質量を算出する制御部と、
を備え、
前記制御部は、
前記力測定部で得られる2点の力測定値の差と、
前記力測定部に連動して前記加速度測定部で得られる2点の加速度測定値の差と、
を用いて前記物品の質量を算出し、
前記力測定部で得られる2点は、最大値点および最小値点である、
質量測定装置。
A mass measuring device that moves the article and calculates the mass of the article from the force and acceleration acting on the article at that time,
A holding mechanism for holding the article;
A moving mechanism for moving the holding mechanism;
A force measuring unit that is provided between the holding mechanism and the moving mechanism and measures a force acting on the article during movement;
An acceleration measuring unit for measuring acceleration acting on the article during movement;
A controller that controls the operation of the holding mechanism and the moving mechanism, and calculates the mass of the article based on the force and acceleration acting on the article during movement;
With
The controller is
A difference between two force measurement values obtained by the force measurement unit;
A difference between two acceleration measurement values obtained by the acceleration measurement unit in conjunction with the force measurement unit;
To calculate the mass of the article,
Two points obtained by the force measuring unit are a maximum value point and a minimum value point.
Mass measuring device.
物品を移動させ、その際に前記物品に作用する力および加速度から前記物品の質量を算出する質量測定装置であって、
前記物品を保持する保持機構と、
前記保持機構を移動させる移動機構と、
前記保持機構と前記移動機構との間に設けられて、移動時の前記物品に作用する力を測定する力測定部と、
移動時の前記物品に作用する加速度を測定する加速度測定部と、
前記保持機構および前記移動機構を運転制御し、移動時の前記物品に作用する力および加速度に基づいて前記物品の質量を算出する制御部と、
を備え、
前記制御部は、
前記加速度測定部で得られる2点の加速度測定値の差と、
前記加速度測定部に連動して前記力測定部で得られる2点の力測定値の差と、
を用いて前記物品の質量を算出し、
前記加速度測定部で得られる2点は、ともに極値点である、
質量測定装置。
A mass measuring device that moves the article and calculates the mass of the article from the force and acceleration acting on the article at that time,
A holding mechanism for holding the article;
A moving mechanism for moving the holding mechanism;
A force measuring unit that is provided between the holding mechanism and the moving mechanism and measures a force acting on the article during movement;
An acceleration measuring unit for measuring acceleration acting on the article during movement;
A controller that controls the operation of the holding mechanism and the moving mechanism, and calculates the mass of the article based on the force and acceleration acting on the article during movement;
With
The controller is
A difference between two acceleration measurement values obtained by the acceleration measurement unit;
A difference between two force measurement values obtained by the force measurement unit in conjunction with the acceleration measurement unit;
To calculate the mass of the article,
The two points obtained by the acceleration measuring unit are both extreme points.
Mass measuring device.
物品を移動させ、その際に前記物品に作用する力および加速度から前記物品の質量を算出する質量測定装置であって、
前記物品を保持する保持機構と、
前記保持機構を移動させる移動機構と、
前記保持機構と前記移動機構との間に設けられて、移動時の前記物品に作用する力を測定する力測定部と、
移動時の前記物品に作用する加速度を測定する加速度測定部と、
前記保持機構および前記移動機構を運転制御し、移動時の前記物品に作用する力および加速度に基づいて前記物品の質量を算出する制御部と、
を備え、
前記制御部は、
前記加速度測定部で得られる2点の加速度測定値の差と、
前記加速度測定部に連動して前記力測定部で得られる2点の力測定値の差と、
を用いて前記物品の質量を算出し、
前記加速度測定部で得られる2点は、最大値点および最小値点である、
質量測定装置。
A mass measuring device that moves the article and calculates the mass of the article from the force and acceleration acting on the article at that time,
A holding mechanism for holding the article;
A moving mechanism for moving the holding mechanism;
A force measuring unit that is provided between the holding mechanism and the moving mechanism and measures a force acting on the article during movement;
An acceleration measuring unit for measuring acceleration acting on the article during movement;
A controller that controls the operation of the holding mechanism and the moving mechanism, and calculates the mass of the article based on the force and acceleration acting on the article during movement;
With
The controller is
A difference between two acceleration measurement values obtained by the acceleration measurement unit;
A difference between two force measurement values obtained by the force measurement unit in conjunction with the acceleration measurement unit;
To calculate the mass of the article,
Two points obtained by the acceleration measuring unit are a maximum value point and a minimum value point.
Mass measuring device.
JP2012084461A 2011-09-20 2012-04-03 Mass measuring device Active JP5977983B2 (en)

Priority Applications (5)

Application Number Priority Date Filing Date Title
JP2012084461A JP5977983B2 (en) 2012-04-03 2012-04-03 Mass measuring device
PCT/JP2012/073856 WO2013042667A1 (en) 2011-09-20 2012-09-18 Mass measurement device
US14/345,723 US9140598B2 (en) 2011-09-20 2012-09-18 Mass measurement device
CN201280045411.1A CN103814279B (en) 2011-09-20 2012-09-18 Apparatus for measuring quality
EP12834227.6A EP2759815B1 (en) 2011-09-20 2012-09-18 Mass measurement device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012084461A JP5977983B2 (en) 2012-04-03 2012-04-03 Mass measuring device

Publications (2)

Publication Number Publication Date
JP2013213749A JP2013213749A (en) 2013-10-17
JP5977983B2 true JP5977983B2 (en) 2016-08-24

Family

ID=49587166

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012084461A Active JP5977983B2 (en) 2011-09-20 2012-04-03 Mass measuring device

Country Status (1)

Country Link
JP (1) JP5977983B2 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104330143A (en) * 2014-11-18 2015-02-04 英华达(南京)科技有限公司 Weighing method and system
JP6480224B2 (en) * 2015-03-19 2019-03-06 株式会社イシダ Mass measuring device

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01260324A (en) * 1988-04-11 1989-10-17 Kawasaki Steel Corp Method for measuring weight of suspended load of crane
JPH03130808A (en) * 1989-10-17 1991-06-04 Citizen Watch Co Ltd Method and device for control of robot
JPH06246652A (en) * 1993-02-23 1994-09-06 Nippon Telegr & Teleph Corp <Ntt> Manipulator device for handling heavy weight object
JPH11351947A (en) * 1998-06-04 1999-12-24 Sony Corp Moving unit with auxiliary power source, method for detecting mass of vehicle with the unit and method for controlling the unit
JP3030307B1 (en) * 1998-12-02 2000-04-10 工業技術院長 Mass measuring device that operates under zero gravity environment
JP2008026263A (en) * 2006-07-25 2008-02-07 Japan Aerospace Exploration Agency Device and method of mass measurement
JP2009018676A (en) * 2007-07-11 2009-01-29 Equos Research Co Ltd Vibration controlling device and vibration controlling method
JP2011047718A (en) * 2009-08-25 2011-03-10 Saitama Univ Mass measuring device

Also Published As

Publication number Publication date
JP2013213749A (en) 2013-10-17

Similar Documents

Publication Publication Date Title
EP2759815B1 (en) Mass measurement device
JP5355077B2 (en) Weighing device, especially multi-row weighing device
US8229694B2 (en) Coordinate measuring machine
KR101485083B1 (en) Rigid Body Property Identification Device and Rigid Body Property Identification Method
US20140238157A1 (en) Robot having workpiece mass measurement function
US20110202300A1 (en) Method for creating correction parameter for posture detecting device, device for creating correction parameter for posture detecting device, and posture detecting device
US11077553B2 (en) Robot and offset correction device for force sensor
JP2013079931A (en) Mass measurement device
JP5977971B2 (en) Mass measuring device
JP5977983B2 (en) Mass measuring device
JP2017181026A (en) Fault diagnosis device, rotational angle sensor, failure diagnosis method, and program
JP4410051B2 (en) Angular velocity measuring device and legged mobile robot
JP5977960B2 (en) Mass measuring device
JP6513367B2 (en) Mass measuring device
JP2013174570A (en) Mass measurement device
JP6001283B2 (en) Mass measuring device
JP2013185847A (en) Mass measurement device
JP2013185848A (en) Mass measurement device
JP2013174503A (en) Mass measurement device
JP3642639B2 (en) A weighing device having a plurality of load converting means
JP6513357B2 (en) Mass measuring device
JP2019045252A (en) Weighing system
JP4170516B2 (en) Weighing device
JPH10239012A (en) Contour shape measuring method and contour shape measuring machine
JP5235775B2 (en) Indentation testing machine

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20150401

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20160315

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20160511

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: 20160719

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20160725

R150 Certificate of patent or registration of utility model

Ref document number: 5977983

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250