[go: up one dir, main page]

JP6925653B2 - Force sensor - Google Patents

Force sensor Download PDF

Info

Publication number
JP6925653B2
JP6925653B2 JP2019176114A JP2019176114A JP6925653B2 JP 6925653 B2 JP6925653 B2 JP 6925653B2 JP 2019176114 A JP2019176114 A JP 2019176114A JP 2019176114 A JP2019176114 A JP 2019176114A JP 6925653 B2 JP6925653 B2 JP 6925653B2
Authority
JP
Japan
Prior art keywords
displacement
force
electric signal
axis
force sensor
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
JP2019176114A
Other languages
Japanese (ja)
Other versions
JP2020012844A5 (en
JP2020012844A (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.)
Tri Force Management Corp
Original Assignee
Tri Force Management Corp
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
Priority claimed from JP2018512355A external-priority patent/JP6617251B1/en
Application filed by Tri Force Management Corp filed Critical Tri Force Management Corp
Priority to JP2019176114A priority Critical patent/JP6925653B2/en
Publication of JP2020012844A publication Critical patent/JP2020012844A/en
Publication of JP2020012844A5 publication Critical patent/JP2020012844A5/ja
Application granted granted Critical
Publication of JP6925653B2 publication Critical patent/JP6925653B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Force Measurement Appropriate To Specific Purposes (AREA)

Description

本発明は、力覚センサに関し、特に、所定の軸方向に作用した力及び所定の回転軸まわりに作用したモーメント(トルク)を電気信号として出力する機能をもったセンサに関する。 The present invention relates to a force sensor, and more particularly to a sensor having a function of outputting a force acting in a predetermined axial direction and a moment (torque) acting around a predetermined rotating axis as an electric signal.

従来、所定の軸方向に作用した力及び所定の回転軸まわりに作用したトルクを電気信号として出力する機能をもった力覚センサが知られている(例えば特許文献1)。このような力覚センサは、産業用ロボットの力制御に広く利用されている他、近年では生活支援ロボットにも採用されており、高い安全性が求められている。しかしながら、例えば、従来の静電容量タイプの力覚センサにおいては、機構部、静電容量の検出部(力の検出部)、マイコンを含む電子回路を備えているが、結露、衝撃、過負荷、あるいは容量素子を構成する一対の平行平板間に異物が混入することによって、故障してしまう可能性がある。特には、力覚センサの力検出部は、可撓性を有するため、過負荷や繰り返し荷重によって金属疲労を生じる。このことにより、当該力検出部を構成する弾性体にクラック等が生じ、最終的には破断してしまう恐れがある。 Conventionally, a force sensor having a function of outputting a force acting in a predetermined axial direction and a torque acting around a predetermined rotating axis as an electric signal is known (for example, Patent Document 1). Such force sensors are widely used for force control of industrial robots, and in recent years, they have also been adopted for life support robots, and high safety is required. However, for example, a conventional capacitance type force sensor is provided with an electronic circuit including a mechanism unit, a capacitance detection unit (force detection unit), and a microcomputer, but condensation, impact, and overload are provided. Or, there is a possibility of failure due to foreign matter being mixed between the pair of parallel flat plates constituting the capacitive element. In particular, since the force detection unit of the force sensor has flexibility, metal fatigue occurs due to overload or repeated load. This may cause cracks or the like in the elastic body constituting the force detection unit, and eventually break the elastic body.

力覚センサが故障しているか否かを判断する簡便な方法としては、例えば特許文献1に記載されている力覚センサを複数(例えば3つ)並列に並べ、各力覚センサの出力信号の差を評価すればよい。この方法では、3つの出力信号を2つずつ比較し、各2つの力覚センサの出力信号の差が所定の範囲内に存在していれば当該力覚センサは正常に機能していると判断され、一方で当該差が所定の範囲内に存在していなければ、当該力覚センサは正常に機能していない(故障している)と判断される。 As a simple method for determining whether or not the force sensor is out of order, for example, a plurality (for example, three) force sensors described in Patent Document 1 are arranged in parallel, and the output signal of each force sensor is displayed. The difference should be evaluated. In this method, three output signals are compared by two, and if the difference between the output signals of each of the two force sensors is within a predetermined range, it is determined that the force sensor is functioning normally. On the other hand, if the difference does not exist within a predetermined range, it is determined that the force sensor is not functioning normally (failed).

特開2004−354049号公報Japanese Unexamined Patent Publication No. 2004-354049

しかしながら、複数の力覚センサを用いて当該力覚センサが正常に機能しているか否かを判断する方法を採用した場合、力覚センサの個数に応じてコストが増大してしまう。更に、力覚センサを設置するために必要なスペースも増大してしまうため問題である。もちろん、ロボット等に取り付けられた力覚センサを取り外して故障診断を行うことにより、当該力覚センサが正常に機能しているか否かを判定しても良い。しかしながら、一度取り付けられた力覚センサを取り外すと作業コストが増大してしまうため、より簡便に故障診断を行うことができる力覚センサが望まれていた。 However, when a method of determining whether or not the force sensor is functioning normally by using a plurality of force sensors is adopted, the cost increases according to the number of force sensors. Further, the space required for installing the force sensor is also increased, which is a problem. Of course, it may be determined whether or not the force sensor is functioning normally by removing the force sensor attached to the robot or the like and performing a failure diagnosis. However, since the work cost increases when the force sensor once attached is removed, a force sensor that can perform failure diagnosis more easily has been desired.

ところで、本出願人は、静電容量型の力覚センサにおいて、低価格かつ高感度であり、使用環境の温度変化や同相ノイズによる影響を受けにくい力覚センサを発明し、特願2017−185184を出願した。このような力覚センサにおいても、より簡便に故障診断を行うことができれば、極めて有用である。 By the way, the applicant has invented a force sensor that is inexpensive, has high sensitivity, and is not easily affected by temperature changes in the usage environment and in-phase noise in the capacitance type force sensor. I applied for. Even in such a force sensor, it would be extremely useful if a failure diagnosis could be performed more easily.

本発明は、以上のような事情に鑑みて創案されたものである。すなわち、本発明の目的は、低価格かつ高感度でありながら、単一の力覚センサによってそれ自身の故障診断が可能な力覚センサを提供することである。 The present invention has been devised in view of the above circumstances. That is, an object of the present invention is to provide a force sensor capable of diagnosing its own failure by a single force sensor while being inexpensive and having high sensitivity.

本発明の第1の態様による力覚センサは、
受力部と固定部とを有し、前記受力部に作用した力により弾性変形を生じる変形体と、
前記変形体に接続され、当該変形体に生じる弾性変形により変位を生じる変位体と、
前記変位体に生じる変位に基づいて、作用した力を検出する検出回路と、を備え、
前記変形体は、
長手方向を有し、前記受力部と前記固定部との間に配置された傾動部と、
前記受力部と前記傾動部とを接続する第1変形部と、
前記固定部と前記傾動部とを接続する第2変形部と、を有し、
各変形部は、前記傾動部の前記長手方向と交差する方向に延在し、
前記第1変形部と前記傾動部との接続部位と、前記第2変形部と前記傾動部との接続部位とは、当該傾動部の前記長手方向において位置が異なっており、
前記変位体は、前記傾動部に接続されているが前記固定部から離間した変位部を有し、
前記検出回路は、前記変位部に配置された第1変位センサ及び第2変位センサを有し、
前記検出回路は、前記第1変位センサの検出値に基づいて、作用した力を示す第1電気信号を出力し、且つ、前記第2変位センサの検出値に基づいて、作用した力を示す第2電気信号を出力し、当該第1電気信号及び当該第2電気信号に基づいて、力の検出が正常に行われているか否かを判定する。
The force sensor according to the first aspect of the present invention is
A deformed body having a receiving portion and a fixed portion and elastically deformed by the force acting on the receiving portion.
A displacement body that is connected to the deformed body and causes displacement due to elastic deformation that occurs in the deformed body.
A detection circuit that detects the applied force based on the displacement generated in the displacement body is provided.
The variant is
A tilting portion having a longitudinal direction and arranged between the receiving portion and the fixing portion,
A first deformed portion that connects the receiving portion and the tilting portion, and
It has a second deformed portion that connects the fixed portion and the tilting portion, and has.
Each deformed portion extends in a direction intersecting the longitudinal direction of the tilted portion.
The connection portion between the first deformed portion and the tilting portion and the connecting portion between the second deformed portion and the tilting portion are different in position in the longitudinal direction of the tilting portion.
The displacement body has a displacement portion that is connected to the tilting portion but is separated from the fixed portion.
The detection circuit has a first displacement sensor and a second displacement sensor arranged in the displacement portion.
The detection circuit outputs a first electric signal indicating the applied force based on the detected value of the first displacement sensor, and indicates the applied force based on the detected value of the second displacement sensor. 2 An electric signal is output, and it is determined whether or not force detection is normally performed based on the first electric signal and the second electric signal.

前記検出回路は、前記第1電気信号と前記第2電気信号との和である合算電気信号を出力し、
前記検出回路は、前記合算電気信号と、前記第1電気信号及び前記第2電気信号の少なくとも一方と、に基づいて、力の検出が正常に行われているか否かを判定して良い。
The detection circuit outputs a total electric signal which is the sum of the first electric signal and the second electric signal.
The detection circuit may determine whether or not force detection is normally performed based on the total electric signal and at least one of the first electric signal and the second electric signal.

以上の力覚センサは、前記変位体に対向配置され、前記固定部に接続された支持体を更に備え、
各変位センサは、前記変位体の前記変位部に配置された変位電極と、この変位電極に対向して前記支持体上に配置された固定電極と、を有する容量素子であって良い。
The above-mentioned force sensor is further provided with a support that is arranged to face the displacement body and is connected to the fixed portion.
Each displacement sensor may be a capacitive element having a displacement electrode arranged in the displacement portion of the displacement body and a fixed electrode arranged on the support so as to face the displacement electrode.

前記変位部は、前記傾動部の前記長手方向と交差する方向に延在する梁を有していて良い。 The displacement portion may have a beam extending in a direction intersecting the longitudinal direction of the tilt portion.

前記梁には、第1計測部位が規定され、
前記検出回路は、前記第1計測部位の変位を計測する、第1−1変位センサ及び第1−2変位センサを有し、
前記検出回路は、前記第1−1変位センサの検出値に基づいて前記第1電気信号を出力し、且つ、前記第1−2変位センサの検出値に基づいて前記第2電気信号を出力して良い。
A first measurement site is defined on the beam,
The detection circuit has a 1-1 displacement sensor and a 1-2 displacement sensor that measure the displacement of the first measurement site.
The detection circuit outputs the first electric signal based on the detection value of the 1-1 displacement sensor, and outputs the second electric signal based on the detection value of the 1-2 displacement sensor. It's okay.

あるいは、前記梁には、第1計測部位及び第2計測部位が規定され、
前記検出回路は、前記第1計測部位の変位を計測する、第1−1変位センサ及び第1−2変位センサと、前記第2計測部位の変位を計測する、第2−1変位センサ及び第2−2変位センサと、を有し、
前記検出回路は、前記第1−1変位センサ及び前記第1−2変位センサの各検出値に基づいて前記第1電気信号を出力し、且つ、前記第2−1変位センサ及び前記第2−2変位センサの各検出値に基づいて前記第2電気信号を出力して良い。
Alternatively, the beam is defined with a first measurement part and a second measurement part.
The detection circuit has a 1-1 displacement sensor and a 1-2 displacement sensor that measure the displacement of the first measurement site, and a 2-1 displacement sensor and a second displacement sensor that measure the displacement of the second measurement site. Has a 2-2 displacement sensor,
The detection circuit outputs the first electric signal based on the detected values of the 1-1 displacement sensor and the 1-2 displacement sensor, and also outputs the 2-1 displacement sensor and the 2-. 2 The second electric signal may be output based on each detected value of the displacement sensor.

前記変位部は、前記変形体の前記傾動部と前記梁とを接続する接続体を有し、
前記変位体の前記第1計測部位及び前記第2計測部位は、前記接続体と前記梁との接続部位に関して対称的に規定され、
前記検出回路は、前記第1−1変位センサの検出値と前記第2−2変位センサの検出値との差に基づいて前記第1電気信号を出力し、且つ、前記第1−2変位センサの検出値と前記第2−1変位センサの検出値との差に基づいて前記第2電気信号を出力して良い。
The displacement portion has a connecting body that connects the tilting portion of the deformed body and the beam.
The first measurement portion and the second measurement portion of the displacement body are symmetrically defined with respect to the connection portion between the connection body and the beam.
The detection circuit outputs the first electric signal based on the difference between the detection value of the 1-1 displacement sensor and the detection value of the 2-2 displacement sensor, and the 1-2 displacement sensor. The second electric signal may be output based on the difference between the detected value of the 2-1 displacement sensor and the detected value of the 2-1 displacement sensor.

前記検出回路は、前記第1電気信号、または、前記第1電気信号と前記第2電気信号との和である合算電気信号、に基づいて作用した力を検出して良い。 The detection circuit may detect a force acting based on the first electric signal or the total electric signal which is the sum of the first electric signal and the second electric signal.

本発明の第2の態様による力覚センサは、
閉ループ状の変形体であって、2つの受力部と、閉ループ状の経路に沿って前記2つの受力部と交互に配置された2つの固定部と、前記閉ループ状の経路に沿って隣接する前記受力部及び前記固定部を接続し前記受力部に作用した力ないしモーメントにより弾性変形を生じる4つの変形要素と、を有する変形体と、
各変形要素に接続され、当該変形要素に生じる弾性変形により変位を生じる4つの変位体と、
前記4つの変位体に生じる変位に基づいて、作用した力及びモーメントの少なくとも一方を検出する検出回路と、を備え、
前記4つの変形要素は、それぞれ、
長手方向を有し、前記受力部と前記固定部との間に配置された傾動部と、
対応する前記受力部と前記傾動部とを接続する第1変形部と、
対応する前記固定部と前記傾動部とを接続する第2変形部と、を有し、
前記第1変形部及び前記第2変形部は、前記傾動部の前記長手方向と交差する方向に延在し、
前記第1変形部と前記傾動部との接続部位と、前記第2変形部と前記傾動部との接続部位とは、当該傾動部の前記長手方向において位置が異なっており、
前記4つの変位体は、それぞれ、対応する前記傾動部に接続されているが対応する前記固定部から離間した変位部を有し、
前記検出回路は、少なくとも4つの第1変位センサと少なくとも4つの第2変位センサとを有し、
前記少なくとも4つの第1変位センサ及び前記少なくとも4つの第2変位センサは、各変位部に少なくとも1つずつ配置されており、
前記検出回路は、各第1変位センサの検出値に基づいて、作用した力を示す第1電気信号を出力し、且つ、各第2変位センサの検出値に基づいて、作用した力を示す第2電気信号を出力し、当該第1電気信号及び当該前記第2電気信号に基づいて、力の検出が正常に行われているか否かを判定する。
The force sensor according to the second aspect of the present invention is
It is a closed-loop variant, and is adjacent to two receiving portions, two fixed portions alternately arranged along the closed-loop path with the two receiving portions, and the closed-loop path. A deformed body having four deforming elements that connect the receiving portion and the fixing portion to cause elastic deformation due to a force or moment acting on the receiving portion.
Four displacement bodies that are connected to each deformation element and cause displacement due to elastic deformation that occurs in the deformation element.
A detection circuit for detecting at least one of an acting force and a moment based on the displacement generated in the four displacement bodies is provided.
Each of the four deformation elements
A tilting portion having a longitudinal direction and arranged between the receiving portion and the fixing portion,
A first deformed portion that connects the corresponding receiving portion and the tilting portion,
It has a second deformed portion that connects the corresponding fixed portion and the tilted portion.
The first deformed portion and the second deformed portion extend in a direction intersecting the longitudinal direction of the tilting portion.
The connection portion between the first deformed portion and the tilting portion and the connecting portion between the second deformed portion and the tilting portion are different in position in the longitudinal direction of the tilting portion.
Each of the four displacement bodies has a displacement portion connected to the corresponding tilting portion but separated from the corresponding fixed portion.
The detection circuit has at least four first displacement sensors and at least four second displacement sensors.
At least one of the at least four first displacement sensors and the at least four second displacement sensors are arranged in each displacement portion.
The detection circuit outputs a first electric signal indicating the applied force based on the detected value of each first displacement sensor, and indicates the applied force based on the detected value of each second displacement sensor. 2 An electric signal is output, and it is determined whether or not force detection is normally performed based on the first electric signal and the second electric signal.

前記検出回路は、前記第1電気信号と前記第2電気信号との和である合算電気信号を出力し、
前記検出回路は、前記合算電気信号と、前記第1電気信号及び前記第2電気信号の少なくとも一方と、に基づいて、力の検出が正常に行われているか否かを判定して良い。
The detection circuit outputs a total electric signal which is the sum of the first electric signal and the second electric signal.
The detection circuit may determine whether or not force detection is normally performed based on the total electric signal and at least one of the first electric signal and the second electric signal.

このような力覚センサは、前記4つの変位体に対向配置され、前記固定部に接続された支持体を更に備え、
各変位センサは、各変位体の前記変位部に配置された変位電極と、各変位電極に対向して前記支持体上に配置された固定電極と、を有する容量素子であって良い。
Such a force sensor is further provided with a support that is arranged to face the four displacement bodies and is connected to the fixed portion.
Each displacement sensor may be a capacitive element having a displacement electrode arranged in the displacement portion of each displacement body and a fixed electrode arranged on the support so as to face each displacement electrode.

前記4つの変位体は、それぞれ、対応する前記傾動部の前記長手方向と交差する方向に延在する梁を有して良い。 Each of the four displacement bodies may have a beam extending in a direction intersecting the longitudinal direction of the corresponding tilting portion.

各梁には、第1計測部位が規定され、
前記検出回路は、各第1計測部位の変位を計測する、第1−1変位センサ及び第1−2変位センサを有し、
前記検出回路は、各第1−1変位センサの検出値に基づいて前記第1電気信号を出力し、且つ、各第1−2変位センサの検出値に基づいて前記第2電気信号を出力して良い。
The first measurement site is defined for each beam,
The detection circuit has a 1-1 displacement sensor and a 1-2 displacement sensor that measure the displacement of each first measurement site.
The detection circuit outputs the first electric signal based on the detection value of each 1-1 displacement sensor, and outputs the second electric signal based on the detection value of each 1-2 displacement sensor. It's okay.

あるいは、各梁には、第1計測部位及び第2計測部位が規定され、
前記検出回路は、各第1計測部位の変位を計測する、第1−1変位センサ及び第1−2変位センサと、各第2計測部位の変位を計測する、第2−1変位センサ及び第2−2変位センサと、を有し、
前記検出回路は、各第1−1変位センサ及び各第2−1変位センサの各検出値に基づいて前記第1電気信号を出力し、且つ、各第1−2変位センサ及び各第2−2変位センサの各検出値に基づいて前記第2電気信号を出力して良い。
Alternatively, each beam is defined with a first measurement part and a second measurement part.
The detection circuit has a 1-1 displacement sensor and a 1-2 displacement sensor that measure the displacement of each first measurement site, and a 2-1 displacement sensor and a second displacement sensor that measure the displacement of each second measurement site. Has a 2-2 displacement sensor,
The detection circuit outputs the first electric signal based on the detected values of each 1-1 displacement sensor and each 2-1 displacement sensor, and outputs each 1-2 displacement sensor and each 2-. 2 The second electric signal may be output based on each detected value of the displacement sensor.

各変位部は、前記変形体の前記傾動部と前記梁とを接続する接続体を有し、
各変位体の前記第1計測部位及び前記第2計測部位は、前記接続体と前記梁との接続部位に関して対称的に規定され、
各第1−1変位センサ、各第1−2変位センサ、各第2−2変位センサ及び各第2−1変位センサは、対応する前記梁の長さ方向に沿ってこの順序で配置され、
前記検出回路は、前記第1−1変位センサの検出値と前記第2−1変位センサの検出値との差に基づいて前記第1電気信号を出力し、且つ、前記第1−2変位センサの検出値と前記第2−2変位センサ検出値との差に基づいて前記第2電気信号を出力して良い。
Each displacement portion has a connecting body that connects the tilting portion of the deformed body and the beam.
The first measurement portion and the second measurement portion of each displacement body are symmetrically defined with respect to the connection portion between the connection body and the beam.
Each 1-1 displacement sensor, each 1-2 displacement sensor, each 2-2 displacement sensor and each 2-1 displacement sensor are arranged in this order along the length direction of the corresponding beam.
The detection circuit outputs the first electric signal based on the difference between the detection value of the 1-1 displacement sensor and the detection value of the 2-1 displacement sensor, and the 1-2 displacement sensor. The second electric signal may be output based on the difference between the detected value of 2-2 and the detected value of the 2-2 displacement sensor.

前記検出回路は、前記第1電気信号、または、前記第1電気信号と前記第2電気信号との和である合算電気信号に基づいて、作用した力を検出して良い。 The detection circuit may detect the acting force based on the first electric signal or the total electric signal which is the sum of the first electric signal and the second electric signal.

また、前記検出回路は、前記合算電気信号と、前記第1電気信号及び前記第2電気信号の少なくとも一方と、の差または比に基づいて、力の検出が正常に行われているか否かを判定して良い。 Further, the detection circuit determines whether or not the force is normally detected based on the difference or ratio between the total electric signal and at least one of the first electric signal and the second electric signal. You may judge.

本発明の第3の態様による力覚センサは、
受力部と固定部とを有し、前記受力部に作用した力により弾性変形を生じる変形体と、
前記変形体に接続され、当該変形体に生じる弾性変形により変位を生じる変位体と、
前記変位体に生じる変位に基づいて、作用した力を検出する検出回路と、を備え、
前記変形体は、
長手方向を有し、前記受力部と前記固定部との間に当該受力部から当該固定部に向かって順次配置された第1傾動部及び第2傾動部と、
前記第1傾動部と前記第2傾動部との間に配置された力伝達部と、
前記受力部と前記第1傾動部とを接続する第1−1変形部、前記力伝達部と前記第1傾動部とを接続する第1−2変形部、前記力伝達部と前記第2傾動部とを接続する第2−1変形部、及び、前記固定部と前記第2傾動部とを接続する第2−2変形部と、を有し、
各変形部は、それぞれ、各傾動部の前記長手方向と交差する方向に延在し、
前記第1−1変形部と前記第1傾動部との接続部位と、前記第1−2変形部と前記第1傾動部との接続部位とは、当該第1傾動部の前記長手方向において位置が異なっており、
前記第2−1変形部と前記第2傾動部との接続部位と、前記第2−2変形部と前記第2傾動部との接続部位とは、当該第2傾動部の前記長手方向において位置が異なっており、
前記第1−1変形部及び第1−2変形部のバネ定数と、前記第2−1変形部及び第2−2変形部のバネ定数とが、異なっており、
前記変位体は、前記第1傾動部に接続されているが前記固定部から離間した第1変位部と、前記第2傾動部に接続されているが前記固定部から離間した第2変位部と、を有し、
前記検出回路は、前記第1変位部の変位を計測する第1変位センサと、前記第2変位部の変位を計測する第2変位センサと、を有し、
前記検出回路は、前記第1変位センサの検出値に基づいて作用した力を示す第1電気信号を出力し、且つ、前記第2変位センサの検出値に基づいて作用した力を示す第2電気信号を出力し、当該第1電気信号と当該第2電気信号との比率の変化に基づいて、力の検出が正常に行われているか否かを判定する。
The force sensor according to the third aspect of the present invention is
A deformed body having a receiving portion and a fixed portion and elastically deformed by the force acting on the receiving portion.
A displacement body that is connected to the deformed body and causes displacement due to elastic deformation that occurs in the deformed body.
A detection circuit that detects the applied force based on the displacement generated in the displacement body is provided.
The variant is
A first tilting portion and a second tilting portion which have a longitudinal direction and are sequentially arranged between the receiving portion and the fixed portion from the receiving portion toward the fixed portion.
A force transmission unit arranged between the first tilting portion and the second tilting portion,
The 1-1 deformed part that connects the force receiving part and the first tilting part, the 1-2 deforming part that connects the force transmitting part and the first tilting part, the force transmitting part and the second It has a 2-1 deformed portion that connects the tilting portion and a 2-2 deformed portion that connects the fixed portion and the second tilting portion.
Each deformed portion extends in a direction intersecting the longitudinal direction of each tilted portion.
The connection portion between the 1-1 deformed portion and the first tilting portion and the connecting portion between the 1-2 deformed portion and the first tilting portion are located in the longitudinal direction of the first tilting portion. Is different,
The connection portion between the 2-1 deformed portion and the second tilting portion and the connecting portion between the 2-2 deformed portion and the second tilting portion are located in the longitudinal direction of the second tilting portion. Is different,
The spring constants of the 1-1 deformed portion and the 1-2 deformed portion and the spring constants of the 2-1 deformed portion and the 2-2 deformed portion are different.
The displacement body includes a first displacement portion connected to the first tilting portion but separated from the fixed portion, and a second displacement portion connected to the second tilting portion but separated from the fixed portion. , Has,
The detection circuit includes a first displacement sensor that measures the displacement of the first displacement portion and a second displacement sensor that measures the displacement of the second displacement portion.
The detection circuit outputs a first electric signal indicating a force acting based on the detection value of the first displacement sensor, and second electricity indicating a force acting based on the detection value of the second displacement sensor. A signal is output, and it is determined whether or not force detection is normally performed based on the change in the ratio of the first electric signal and the second electric signal.

このような力覚センサは、前記変位体に対向配置され、前記固定部に接続された支持体を更に備え、
各変位センサは、前記変位体の各変位部に配置された変位電極と、この変位電極に対向して前記支持体上に配置された固定電極と、を有する容量素子であって良い。
Such a force sensor is further provided with a support that is arranged to face the displacement body and is connected to the fixed portion.
Each displacement sensor may be a capacitive element having a displacement electrode arranged in each displacement portion of the displacement body and a fixed electrode arranged on the support so as to face the displacement electrode.

前記第1変位部は、前記第1傾動部の前記長手方向と交差する方向に延在する第1梁を有し、
前記第2変位部は、前記第2傾動部の前記長手方向と交差する方向に延在する第2梁を有して良い。
The first displacement portion has a first beam extending in a direction intersecting the longitudinal direction of the first tilt portion.
The second displacement portion may have a second beam extending in a direction intersecting the longitudinal direction of the second tilt portion.

前記第1梁には、第1−1計測部位が規定され、
前記第2梁には、第2−1計測部位が規定され、
前記検出回路は、前記第1−1計測部位の変位を計測する第1−1変位センサと、前記第2−1計測部位の変位を計測する第2−1変位センサと、を有し、
前記検出回路は、前記第1−1変位センサの検出値に基づいて前記第1電気信号を出力し、且つ、前記第2−1変位センサの検出値に基づいて前記第2電気信号を出力して良い。
A 1-1 measurement site is defined on the first beam.
A 2-1 measurement site is defined on the second beam.
The detection circuit includes a 1-1 displacement sensor that measures the displacement of the 1-1 measurement site and a 2-1 displacement sensor that measures the displacement of the 2-1 measurement site.
The detection circuit outputs the first electric signal based on the detection value of the 1-1 displacement sensor, and outputs the second electric signal based on the detection value of the 2-1 displacement sensor. It's okay.

あるいは、前記第1梁には、第1−1計測部位及び第1−2計測部位が規定され、
前記第2梁には、第2−1計測部位及び第2−2計測部位が規定され、
前記検出回路は、前記第1−1計測部位の変位を計測する第1−1変位センサ、前記第1−2計測部位の変位を計測する第1−2変位センサ、前記第2−1計測部位の変位を計測する第2−1変位センサ、及び、前記第2−2計測部位の変位を計測する第2−2変位センサを有し、
前記検出回路は、前記第1−1変位センサ及び前記第1−2変位センサの各検出値に基づいて前記第1電気信号を出力し、且つ、前記第2−1変位センサ及び前記第2−2変位センサの各検出値に基づいて前記第2電気信号を出力して良い。
Alternatively, the first beam is defined with a 1-1 measurement site and a 1-2 measurement site.
A 2-1 measurement site and a 2-2 measurement site are defined on the second beam.
The detection circuit includes a 1-1 displacement sensor that measures the displacement of the 1-1 measurement site, a 1-2 displacement sensor that measures the displacement of the 1-2 measurement site, and the 2-1 measurement site. It has a 2-1 displacement sensor that measures the displacement of the 2-2 and a 2-2 displacement sensor that measures the displacement of the 2-2 measurement site.
The detection circuit outputs the first electric signal based on the detected values of the 1-1 displacement sensor and the 1-2 displacement sensor, and also outputs the 2-1 displacement sensor and the 2-. 2 The second electric signal may be output based on each detected value of the displacement sensor.

前記第1変位部は、前記第1傾動部と前記第1梁とを接続する第1接続体を有し、
前記第2変位部は、前記第2傾動部と前記第2梁とを接続する第2接続体を有し、
前記第1変位部の前記第1−1計測部位及び前記第1−2計測部位は、前記第1接続体と前記第1梁との接続部位に関して対称的に規定され、
前記第2変位部の前記第2−1計測部位及び前記第2−2計測部位は、前記第2接続体と前記第2梁との接続部位に関して対称的に規定され、
前記検出回路は、前記第1−1変位センサの検出値と前記第1−2変位センサの検出値との差に基づいて前記第1電気信号を出力し、前記第2−1変位センサの検出値と前記第2−2変位センサの検出値との差に基づいて前記第2電気信号を出力して良い。
The first displacement portion has a first connecting body that connects the first tilting portion and the first beam.
The second displacement portion has a second connecting body that connects the second tilting portion and the second beam.
The 1-1 measurement portion and the 1-2 measurement portion of the first displacement portion are symmetrically defined with respect to the connection portion between the first connecting body and the first beam.
The 2-1 measurement portion and the 2-2 measurement portion of the second displacement portion are symmetrically defined with respect to the connection portion between the second connecting body and the second beam.
The detection circuit outputs the first electric signal based on the difference between the detection value of the 1-1 displacement sensor and the detection value of the 1-2 displacement sensor, and detects the 2-1 displacement sensor. The second electric signal may be output based on the difference between the value and the value detected by the 2-2 displacement sensor.

本発明の第4の態様による力覚センサは、
閉ループ状の変形体であって、2つの受力部と、閉ループ状の経路に沿って前記2つの受力部と交互に配置された2つの固定部と、前記閉ループ状の経路に沿って隣接する前記受力部及び前記固定部を接続し前記受力部に作用した力ないしモーメントにより弾性変形を生じる4つの変形要素と、を有する変形体と、
各変形要素に接続され、当該変形要素に生じる弾性変形により変位を生じる変位体と、
前記変位体に生じる変位に基づいて、作用した力及びモーメントの少なくとも一方を検出する検出回路と、を備え、
前記4つの変形要素は、それぞれ、
長手方向を有し、前記受力部と前記固定部との間に当該受力部から当該固定部に向かって順次配置された第1傾動部及び第2傾動部と、
前記第1傾動部と前記第2傾動部との間に配置された力伝達部と、
前記第1傾動部と対応する前記受力部とを接続する第1−1変形部、前記力伝達部と前記第1傾動部とを接続する第1−2変形部、前記力伝達部と前記第2傾動部とを接続する第2−1変形部、及び、前記第2傾動部と対応する前記固定部とを接続する第2−2変形部と、を有し、
前記第1−1変形部、前記第1−2変形部、前記第2−1変形部、及び前記第2−2変形部は、各傾動部の前記長手方向と交差する方向に延在し、
前記第1−1変形部と前記第1傾動部との接続部位と、前記第1−2変形部と前記第1傾動部との接続部位とは、当該第1傾動部の前記長手方向において位置が異なっており、
前記第2−1変形部と前記第2傾動部との接続部位と、前記第2−2変形部と前記第2傾動部との接続部位とは、当該第2傾動部の前記長手方向において位置が異なっており、
前記第1−1変形部及び第1−2変形部のバネ定数と、前記第2−1変形部及び第2−2変形部のバネ定数とが、異なっており、
各変位体は、対応する前記第1傾動部に接続されているが各固定部から離間した第1変位部と、対応する第2傾動部に接続されているが各固定部から離間した第2変位部と、を有し、
前記検出回路は、各第1変位部の変位を計測する少なくとも4つの第1変位センサと、各第2変位部の変位を計測する少なくとも4つの第2変位センサと、を有し、
前記検出回路は、各第1変位センサの検出値に基づいて、作用した力を示す第1電気信号を出力し、且つ、各第2変位センサの検出値に基づいて、作用した力を示す第2電気信号を出力し、当該第1電気信号と当該第2電気信号との比率の変化に基づいて、力の検出が正常に行われているか否かを判定する。
The force sensor according to the fourth aspect of the present invention is
It is a closed-loop variant, and is adjacent to two receiving portions, two fixed portions alternately arranged along the closed-loop path with the two receiving portions, and the closed-loop path. A deformed body having four deforming elements that connect the receiving portion and the fixing portion to cause elastic deformation due to a force or moment acting on the receiving portion.
A displacement body that is connected to each deformation element and causes displacement due to elastic deformation that occurs in the deformation element.
A detection circuit for detecting at least one of an acting force and a moment based on the displacement generated in the displacement body is provided.
Each of the four deformation elements
A first tilting portion and a second tilting portion which have a longitudinal direction and are sequentially arranged between the receiving portion and the fixed portion from the receiving portion toward the fixed portion.
A force transmission unit arranged between the first tilting portion and the second tilting portion,
The 1-1 deformed part that connects the first tilting part and the corresponding force receiving part, the 1-2 deformed part that connects the force transmitting part and the first tilting part, the force transmitting part and the said It has a 2-1 deformed portion that connects the second tilted portion and a 2-2 deformed portion that connects the second tilted portion and the corresponding fixed portion.
The 1-1 deformed portion, the 1-2 deformed portion, the 2-1 deformed portion, and the 2-2 deformed portion extend in a direction intersecting the longitudinal direction of each tilting portion.
The connection portion between the 1-1 deformed portion and the first tilting portion and the connecting portion between the 1-2 deformed portion and the first tilting portion are located in the longitudinal direction of the first tilting portion. Is different,
The connection portion between the 2-1 deformed portion and the second tilting portion and the connecting portion between the 2-2 deformed portion and the second tilting portion are located in the longitudinal direction of the second tilting portion. Is different,
The spring constants of the 1-1 deformed portion and the 1-2 deformed portion and the spring constants of the 2-1 deformed portion and the 2-2 deformed portion are different.
Each displacement body has a first displacement portion connected to the corresponding first tilt portion but separated from each fixed portion, and a second displacement portion connected to the corresponding second tilt portion but separated from each fixed portion. With a displacement part,
The detection circuit includes at least four first displacement sensors that measure the displacement of each first displacement portion and at least four second displacement sensors that measure the displacement of each second displacement portion.
The detection circuit outputs a first electric signal indicating the applied force based on the detected value of each first displacement sensor, and indicates the applied force based on the detected value of each second displacement sensor. 2 An electric signal is output, and it is determined whether or not force detection is normally performed based on a change in the ratio of the first electric signal and the second electric signal.

このような力覚センサは、
前記第1変位部及び前記第2変位部に対向配置され、前記固定部に接続された支持体を更に備え、
各変位センサは、前記変位体の各変位部に配置された変位電極と、この変位電極に対向して前記支持体上に配置された固定電極と、を有する容量素子であって良い。
Such a force sensor
A support that is arranged to face the first displacement portion and the second displacement portion and is connected to the fixing portion is further provided.
Each displacement sensor may be a capacitive element having a displacement electrode arranged in each displacement portion of the displacement body and a fixed electrode arranged on the support so as to face the displacement electrode.

各第1変位部は、対応する前記第1傾動部の前記長手方向と交差する方向に延在する第1梁を有し、
各第2変位部は、対応する前記第2傾動部の前記長手方向と交差する方向に延在する第2梁を有して良い。
Each first displacement portion has a first beam extending in a direction intersecting the longitudinal direction of the corresponding first tilt portion.
Each second displacement portion may have a second beam extending in a direction intersecting the longitudinal direction of the corresponding second tilt portion.

各第1梁には、第1−1計測部位が規定され、
各第2梁には、第2−1計測部位が規定され、
前記検出回路は、各第1−1計測部位の変位を計測する第1−1変位センサと、各第2−1計測部位の変位を計測する第2−1変位センサと、を有し、
前記検出回路は、各第1−1変位センサの検出値に基づいて前記第1電気信号を出力し、且つ、各第2−1変位センサの検出値に基づいて前記第2電気信号を出力して良い。
Each first beam is defined with a 1-1 measurement site.
For each second beam, the 2-1 measurement site is defined.
The detection circuit includes a 1-1 displacement sensor that measures the displacement of each 1-1 measurement part, and a 2-1 displacement sensor that measures the displacement of each 2-1 measurement part.
The detection circuit outputs the first electric signal based on the detection value of each 1-1 displacement sensor, and outputs the second electric signal based on the detection value of each 2-1 displacement sensor. It's okay.

あるいは、各第1梁には、第1−1計測部位及び第1−2計測部位が規定され、
各第2梁には、第2−1計測部位及び第2−2計測部位が規定され、
前記検出回路は、各第1−1計測部位の変位を計測する第1−1変位センサ、各第1−2計測部位の変位を計測する第1−2変位センサ、各第2−1計測部位の変位を計測する第2−1変位センサ、及び、各第2−2計測部位の変位を計測する第2−2変位センサを有し、
前記検出回路は、各第1−1変位センサ及び各第1−2変位センサの各検出値に基づいて前記第1電気信号を出力し、且つ、各第2−1変位センサ及び各第2−2変位センサの各検出値に基づいて前記第2電気信号を出力して良い。
Alternatively, each first beam is defined with a 1-1 measurement site and a 1-2 measurement site.
Each second beam is defined with a 2-1 measurement site and a 2-2 measurement site.
The detection circuit includes a 1-1 displacement sensor that measures the displacement of each 1-1 measurement site, a 1-2 displacement sensor that measures the displacement of each 1-2 measurement site, and each 2-1 measurement site. It has a 2-1 displacement sensor that measures the displacement of and a 2-2 displacement sensor that measures the displacement of each 2-2 measurement site.
The detection circuit outputs the first electric signal based on each detection value of each 1-1 displacement sensor and each 1-2 displacement sensor, and each 2-1 displacement sensor and each second 2-. 2 The second electric signal may be output based on each detected value of the displacement sensor.

各第1変位部は、前記第1傾動部と前記第1梁とを接続する第1接続体を有し、
各第2変位部は、前記第2傾動部と前記第2梁とを接続する第2接続体を有し、
前記第1変位部の前記第1−1計測部位及び前記第1−2計測部位は、前記第1接続体と前記第1梁との接続部位に関して対称的に規定され、
前記第2変位部の前記第2−1計測部位及び前記第2−2計測部位は、前記第2接続体と前記第2梁との接続部位に関して対称的に規定され、
前記検出回路は、前記第1−1変位センサの検出値と前記第1−2変位センサの検出値との差に基づいて前記第1電気信号を出力し、且つ、前記第2−1変位センサの検出値と前記第2−2変位センサの検出値との差に基づいて前記第2電気信号を出力して良い。
Each first displacement portion has a first connecting body that connects the first tilting portion and the first beam.
Each second displacement portion has a second connecting body that connects the second tilting portion and the second beam.
The 1-1 measurement portion and the 1-2 measurement portion of the first displacement portion are symmetrically defined with respect to the connection portion between the first connecting body and the first beam.
The 2-1 measurement portion and the 2-2 measurement portion of the second displacement portion are symmetrically defined with respect to the connection portion between the second connecting body and the second beam.
The detection circuit outputs the first electric signal based on the difference between the detection value of the 1-1 displacement sensor and the detection value of the 1-2 displacement sensor, and the 2-1 displacement sensor. The second electric signal may be output based on the difference between the detected value of 2-2 and the detected value of the 2-2 displacement sensor.

前記検出回路は、力の検出が正常に行われているときの前記第1電気信号と前記第2電気信号との比率を基準比率として記憶しており、
前記検出回路は、前記第1電気信号と前記第2電気信号との比率と、前記基準比率と、の差、に基づいて力の検出が正常に行われているか否かを判定して良い。
The detection circuit stores the ratio of the first electric signal and the second electric signal when the force is normally detected as a reference ratio.
The detection circuit may determine whether or not force detection is normally performed based on the difference between the ratio of the first electric signal and the second electric signal and the reference ratio.

以上の各力覚センサにおいて、前記受力部は、前記固定部に対する相対移動が所定の範囲内に制限されて良い。 In each of the above force sensors, the relative movement of the receiving portion with respect to the fixed portion may be restricted within a predetermined range.

あるいは、前記受力部は、前記固定部及び前記支持体の少なくとも一方に対する相対移動が所定の範囲内に制限されていて良い。 Alternatively, the receiving portion may be restricted in relative movement to at least one of the fixed portion and the support within a predetermined range.

本発明の第5の態様による力覚センサは、
受力部と固定部とを有し、前記受力部に作用した力により弾性変形を生じる変形体と、
前記変形体に接続され、当該変形体に生じる弾性変形により変位を生じる変位体と、
前記変位体に生じる変位に基づいて、作用した力を検出する検出回路と、
前記固定部に接続された支持体と、を備え、
前記変形体は、
長手方向を有し、前記受力部と前記固定部との間に配置された傾動部と、
前記受力部と前記傾動部とを接続する第1変形部と、
前記固定部と前記傾動部とを接続する第2変形部と、を有し、
各変形部は、前記傾動部の前記長手方向と交差する方向に延在し、
前記第1変形部と前記傾動部との接続部位と、前記第2変形部と前記傾動部との接続部位とは、当該傾動部の前記長手方向において位置が異なっており、
前記変位体は、前記傾動部に接続されているが前記固定部から離間した変位部を有し、
前記受力部は、前記固定部及び前記支持体の少なくとも一方に対する相対移動が所定の範囲内に制限される。
The force sensor according to the fifth aspect of the present invention is
A deformed body having a receiving portion and a fixed portion and elastically deformed by the force acting on the receiving portion.
A displacement body that is connected to the deformed body and causes displacement due to elastic deformation that occurs in the deformed body.
A detection circuit that detects the applied force based on the displacement generated in the displacement body, and
With a support connected to the fixing portion,
The variant is
A tilting portion having a longitudinal direction and arranged between the receiving portion and the fixing portion,
A first deformed portion that connects the receiving portion and the tilting portion, and
It has a second deformed portion that connects the fixed portion and the tilting portion, and has.
Each deformed portion extends in a direction intersecting the longitudinal direction of the tilted portion.
The connection portion between the first deformed portion and the tilting portion and the connecting portion between the second deformed portion and the tilting portion are different in position in the longitudinal direction of the tilting portion.
The displacement body has a displacement portion that is connected to the tilting portion but is separated from the fixed portion.
The receiving portion is restricted to move relative to at least one of the fixed portion and the support within a predetermined range.

以上の力覚センサは、前記固定部に接続された支持体を更に備え、
前記支持体と前記受力部との離間距離により、前記所定の範囲が画定されて良い。
The above-mentioned force sensor further includes a support connected to the fixed portion, and further comprises a support.
The predetermined range may be defined by the distance between the support and the receiving portion.

以上の力覚センサは、前記変形体の前記固定部及び前記支持体の少なくとも一方に接続され、当該固定部及び当該支持体の少なくとも一方に対する前記受力部の相対移動を前記所定の範囲に制限するストッパを更に備えて良い。 The above-mentioned force sensor is connected to at least one of the fixed portion and the support of the deformed body, and limits the relative movement of the receiving portion with respect to at least one of the fixed portion and the support within the predetermined range. A stopper may be further provided.

前記受力部は、凹部または貫通孔を有し、
前記ストッパの少なくとも一部は、前記凹部または前記貫通孔の内部に位置して良い。
The receiving portion has a recess or a through hole and has a recess or a through hole.
At least a part of the stopper may be located inside the recess or the through hole.

本発明の第1の実施の形態による力覚センサの基本構造を示す概略正面図である。It is a schematic front view which shows the basic structure of the force sensor by 1st Embodiment of this invention. 図1の概略上面図である。It is a schematic top view of FIG. 受力部にX軸正方向の力+Fxが作用したときの基本構造の変形状態を示す概略正面図である。It is a schematic front view which shows the deformed state of the basic structure when the force + Fx in the positive direction of the X axis is applied to the force receiving part. 受力部にX軸負方向の力−Fxが作用したときの基本構造の変形状態を示す概略正面図である。It is a schematic front view which shows the deformed state of the basic structure when a force −Fx in the negative direction of the X axis is applied to a force receiving part. 受力部にZ軸負方向の力−Fzが作用したときの基本構造の変形状態を示す概略正面図である。It is a schematic front view which shows the deformation state of the basic structure when the force −Fz in the negative direction of the Z axis is applied to a force receiving part. 受力部にZ軸正方向の力+Fzが作用したときの基本構造の変形状態を示す概略正面図である。It is a schematic front view which shows the deformed state of a basic structure when a force + Fz in the positive direction of the Z axis is applied to a force receiving part. 図1に示す基本構造を採用した力覚センサの例を示す概略正面図である。It is a schematic front view which shows the example of the force sensor which adopted the basic structure shown in FIG. 本実施の形態の力覚センサに採用されている検出回路のブロック図である。It is a block diagram of the detection circuit adopted in the force sensor of this embodiment. 図7の力覚センサに力+Fx及び−Fzが作用した際の、各容量素子の静電容量値の変動を示す図表である。It is a figure which shows the fluctuation of the capacitance value of each capacitance element when the force + Fx and −Fz act on the force sensor of FIG. 7. 本発明の第2の実施の形態による力覚センサの基本構造を示す概略正面図である。It is a schematic front view which shows the basic structure of the force sensor by the 2nd Embodiment of this invention. 受力部にX軸正方向の力+Fx及びZ軸負方向の力−Fzが作用した際に、各計測部位に生じるZ軸方向の変位を纏めて示す図表である。It is a chart which shows the displacement in the Z-axis direction which occurs in each measurement part when the force in the X-axis positive direction + Fx and the force-Fz in the Z-axis negative direction act on the receiving part. 図10の基本構造を採用した力覚センサの例を示す概略正面図である。It is a schematic front view which shows the example of the force sensor which adopted the basic structure of FIG. 図12の力覚センサに採用されている検出回路のブロック図である。It is a block diagram of the detection circuit adopted in the force sensor of FIG. 図12の力覚センサに力+Fx及び−Fzが作用した際の、各容量素子の静電容量値の変動を示す図表である。It is a figure which shows the fluctuation of the capacitance value of each capacitance element when the force + Fx and −Fz act on the force sensor of FIG. 図12の力覚センサの変形体に金属疲労が生じていないときの、受力部に作用するX軸正方向の力+Fxと電気信号T1、T2との関係を示すグラフである。It is a graph which shows the relationship between the X-axis positive direction force + Fx acting on the receiving part, and electric signals T1 and T2 when metal fatigue does not occur in the deformed body of the force sensor of FIG. 図12の力覚センサの変形体に金属疲労が生じているときの、受力部に作用するX軸正方向の力+Fxと電気信号T1、T2との関係を示すグラフである。It is a graph which shows the relationship between the X-axis positive direction force + Fx acting on the receiving part, and the electric signals T1 and T2 when metal fatigue occurs in the deformed body of the force sensor of FIG. 本発明の第3の実施の形態による力覚センサの基本構造を示す概略上面図である。It is a schematic top view which shows the basic structure of the force sensor by the 3rd Embodiment of this invention. 図17のY軸正側から見た基本構造を示す概略正面図である。It is a schematic front view which shows the basic structure seen from the Y-axis positive side of FIG. 図17のX軸正側から見た基本構造を示す概略側面図である。It is a schematic side view which shows the basic structure seen from the X-axis positive side of FIG. 受力部にX軸正方向の力+Fxが作用したときに、図17の基本構造の各変位体に生じる変位を説明するための図である。It is a figure for demonstrating the displacement which occurs in each displacement body of the basic structure of FIG. 17 when the force + Fx in the positive direction of the X axis acts on the receiving part. 受力部にY軸正方向の力+Fyが作用したときに、図17の基本構造の各変位体に生じる変位を説明するための図である。It is a figure for demonstrating the displacement which occurs in each displacement body of the basic structure of FIG. 17 when the force + Fy in the positive direction of the Y axis acts on the force receiving part. 受力部にZ軸正方向の力+Fzが作用したときに、図17の基本構造の各変位体に生じる変位を説明するための図である。It is a figure for demonstrating the displacement which occurs in each displacement body of the basic structure of FIG. 17 when the force + Fz in the Z-axis positive direction acts on the force receiving part. 受力部にX軸正まわりのモーメント+Mxが作用したときに、図17の基本構造の各変位体に生じる変位を説明するための図である。It is a figure for demonstrating the displacement which occurs in each displacement body of the basic structure of FIG. 17 when the moment + Mx around the X-axis acts on the receiving part. 受力部にY軸正まわりのモーメント+Myが作用したときに、図17の基本構造の各変位体に生じる変位を説明するための図である。It is a figure for demonstrating the displacement which occurs in each displacement body of the basic structure of FIG. 17 when the moment of the positive direction of Y axis + My acts on the receiving part. 受力部にZ軸正まわりのモーメント+Mzが作用したときに、図17の基本構造の各変位体に生じる変位を説明するための図である。It is a figure for demonstrating the displacement which occurs in each displacement body of the basic structure of FIG. 受力部にXYZ三次元座標系の各軸方向の力及び各軸方向のモーメントが作用したときに図17の基本構造の各計測部位に生じる変位を一覧で示す図表である。It is a chart which shows the displacement which occurs in each measurement part of the basic structure of FIG. 17 in a list when the force in each axial direction and the moment in each axial direction are applied to the force receiving part of the XYZ three-dimensional coordinate system. 図17に示す基本構造を採用した力覚センサの例を示す概略上面図である。It is a schematic top view which shows the example of the force sensor which adopted the basic structure shown in FIG. Y軸正側から見たときの、図27に示す力覚センサを示す概略正面図である。It is a schematic front view which shows the force sensor shown in FIG. 27 when viewed from the Y-axis positive side. XYZ三次元座標系における各軸方向の力及び各軸まわりのモーメントが作用したときの、図27に示す力覚センサの各容量素子の静電容量値の増減を一覧で示す図表である。It is a chart which shows the increase / decrease of the capacitance value of each capacitance element of the force sensor shown in FIG. 27 when the force in each axis direction and the moment around each axis act in the XYZ three-dimensional coordinate system. 図27に示す力覚センサについて、各軸方向の力及び各軸まわりのモーメントの他軸感度を一覧で示す図表である。For the force sensor shown in FIG. 27, it is a chart showing a list of forces in each axial direction and other axial sensitivities of moments around each axis. 本発明の第4の実施の形態による力覚センサを示す概略上面図である。It is a schematic top view which shows the force sensor by the 4th Embodiment of this invention. 図31に示す力覚センサに力及びモーメントの4つの成分が作用したときの、各容量素子の静電容量値の変動を一覧で示す図表である。It is a chart which shows the fluctuation of the capacitance value of each capacitive element in a list when four components of a force and a moment act on the force sensor shown in FIG. 31. 図31に示す力覚センサについて、各軸方向の力及び各軸まわりのモーメントの他軸感度を一覧で示す図表である。For the force sensor shown in FIG. 31, it is a chart showing a list of forces in each axial direction and other axial sensitivities of moments around each axis. 図31の変形例による力覚センサを示す概略上面図である。It is a schematic top view which shows the force sensor by the modification of FIG. 31. 本発明の第5の実施の形態による力覚センサを示す概略上面図である。It is a schematic top view which shows the force sensor by the 5th Embodiment of this invention. 図35に示す力覚センサに力及びモーメントの4つの成分Fx、Fy、Fz、Mzが作用したときの、各容量素子の静電容量値の変動を一覧で示す図表である。It is a chart which shows the fluctuation of the capacitance value of each capacitance element at the time when the four components Fx, Fy, Fz, and Mz of a force and a moment act on the force sensor shown in FIG. 35. 第5の実施の形態の変形例による力覚センサを示す概略上面図である。It is a schematic top view which shows the force sensor by the modification of the 5th Embodiment. 本発明の第6の実施の形態による力覚センサを示す概略上面図である。It is a schematic top view which shows the force sensor by 6th Embodiment of this invention. XYZ三次元座標系における各軸方向の力及び各軸まわりのモーメントが作用したときの、図38に示す力覚センサの各容量素子の静電容量値の増減を一覧で示す図表である。It is a chart which shows the increase / decrease of the capacitance value of each capacitance element of the force sensor shown in FIG. 38 when the force in each axis direction and the moment around each axis act in the XYZ three-dimensional coordinate system. 図27の変形例による力覚センサを示す概略上面図である。It is a schematic top view which shows the force sensor by the modification of FIG. 27. 図27の更なる変形例による力覚センサを示す概略上面図である。It is a schematic top view which shows the force sensor by the further modification of FIG. 27. 受力部にXYZ三次元座標系における各軸方向の力及び各軸方向のモーメントFx〜Mzが作用したときに、図41の力覚センサの各傾動部に生じる傾動の向きと、各変位部に生じる変位とを、一覧で示す図表である。When a force in each axial direction and moments Fx to Mz in each axial direction are applied to the force receiving portion in the XYZ three-dimensional coordinate system, the direction of tilt generated in each tilting portion of the force sensor in FIG. 41 and each displacement portion. It is a chart which shows the displacement which occurs in a list. 過負荷を防止するためのストッパ機構を備えた基本構造を示す概略正面図である。It is a schematic front view which shows the basic structure provided with the stopper mechanism for preventing an overload. 受力部に過大なZ軸負方向の力−Fzが作用したときの、図43に示す基本構造の変形状態を示す概略正面図である。FIG. 5 is a schematic front view showing a deformed state of the basic structure shown in FIG. 43 when an excessive force −Fz in the negative direction of the Z axis is applied to the receiving portion. 他の例による過負荷を防止するためのストッパ機構を備えた基本構造を示す概略正面図である。It is a schematic front view which shows the basic structure provided with the stopper mechanism for preventing the overload by another example. 図45の概略平面図である。It is a schematic plan view of FIG. 45. 受力部に過大なX軸正方向の力+Fxが作用したときの、図45に示す基本構造の変形状態を示す概略正面図である。FIG. 5 is a schematic front view showing a deformed state of the basic structure shown in FIG. 45 when an excessive force in the positive direction of the X-axis + Fx is applied to the receiving portion. 受力部に過大なX軸負方向の力−Fxが作用したときの、図45に示す基本構造の変形状態を示す概略正面図である。FIG. 5 is a schematic front view showing a deformed state of the basic structure shown in FIG. 45 when an excessive force −Fx in the negative direction of the X axis acts on the receiving portion. 受力部に過大なZ軸負方向の力−Fzが作用したときの、図45に示す基本構造の変形状態を示す概略正面図である。FIG. 5 is a schematic front view showing a deformed state of the basic structure shown in FIG. 45 when an excessive force −Fz in the negative direction of the Z axis is applied to the receiving portion. 受力部に過大なZ軸正方向の力+Fzが作用したときの、図45に示す基本構造の変形状態を示す概略正面図である。FIG. 5 is a schematic front view showing a deformed state of the basic structure shown in FIG. 45 when an excessive force + Fz in the positive direction of the Z axis is applied to the receiving portion. 更に他の例による過負荷を防止するためのストッパ機構を備えた基本構造を示す概略正面図である。It is a schematic front view which shows the basic structure provided with the stopper mechanism for preventing the overload by another example. 図51の概略平面図である。It is a schematic plan view of FIG. 51. 受力部に過大なX軸正方向の力+Fxが作用したときの、図51に示す基本構造の変形状態を示す概略正面図である。FIG. 5 is a schematic front view showing a deformed state of the basic structure shown in FIG. 51 when an excessive force in the positive direction of the X-axis + Fx is applied to the receiving portion. 受力部に過大なX軸負方向の力−Fxが作用したときの、図51に示す基本構造の変形状態を示す概略正面図である。FIG. 5 is a schematic front view showing a deformed state of the basic structure shown in FIG. 51 when an excessive force −Fx in the negative direction of the X axis acts on the receiving portion. 受力部に過大なZ軸負方向の力−Fzが作用したときの、図51に示す基本構造の変形状態を示す概略正面図である。FIG. 5 is a schematic front view showing a deformed state of the basic structure shown in FIG. 51 when an excessive force −Fz in the negative direction of the Z axis is applied to the receiving portion. 受力部に過大なZ軸正方向の力+Fzが作用したときの、図51に示す基本構造の変形状態を示す概略正面図である。FIG. 5 is a schematic front view showing a deformed state of the basic structure shown in FIG. 51 when an excessive force in the positive direction of the Z axis + Fz acts on the receiving portion. 図43の変形例による基本構造を示す概略正面図である。It is a schematic front view which shows the basic structure by the modification of FIG. 43. 変位体が片持ち梁の構造を有する、図7の変形例による力覚センサの概略正面図である。It is a schematic front view of the force sensor according to the modification of FIG. 7 in which the displacement body has a structure of a cantilever. 変位体が片持ち梁の構造を有する、図12の変形例による力覚センサの概略正面図である。It is a schematic front view of the force sensor according to the modification of FIG. 12 in which the displacement body has a structure of a cantilever.

<<< §1. 本発明の第1の実施の形態による力覚センサ >>>
< 1−1. 基本構造の構成 >
添付の図面を参照して、本発明の第1の実施の形態による力覚センサについて説明する。
<<< §1. Force sensor according to the first embodiment of the present invention >>>
<1-1. Structure of basic structure >
The force sensor according to the first embodiment of the present invention will be described with reference to the accompanying drawings.

図1は、本発明の一実施の形態による力覚センサの基本構造100を示す概略正面図であり、図2は、その概略上面図である。ここでは、図1及び図2に示すようにXYZ三次元座標系を定義して以下の説明を行うこととする。 FIG. 1 is a schematic front view showing a basic structure 100 of a force sensor according to an embodiment of the present invention, and FIG. 2 is a schematic top view thereof. Here, the XYZ three-dimensional coordinate system is defined as shown in FIGS. 1 and 2, and the following description will be given.

図1及び図2に示すように、基本構造100は、受力部14と固定部15とを有し、受力部14に作用した力により弾性変形を生じる変形体10と、変形体10に接続され、当該変形体10に生じる弾性変形により変位を生じる変位体20と、を備えている。受力部14は、検出対象となる力を受ける部位であり、固定部15は、受力部14に力が作用してもXYZ三次元座標系において変位しない部位である。 As shown in FIGS. 1 and 2, the basic structure 100 has a receiving portion 14 and a fixing portion 15, and the deformed body 10 and the deformed body 10 which are elastically deformed by the force acting on the receiving portion 14 It is provided with a displacement body 20 that is connected and causes a displacement due to elastic deformation that occurs in the deformed body 10. The receiving portion 14 is a portion that receives a force to be detected, and the fixing portion 15 is a portion that does not displace in the XYZ three-dimensional coordinate system even if a force acts on the receiving portion 14.

本実施の形態において、図1及び図2に示すように、変形体10は、Z軸と平行な長手方向lを有し受力部14と固定部15との間に配置された傾動部13と、受力部Pと傾動部13とを接続する第1変形部11と、固定部15と傾動部13とを接続する第2変形部12と、を有している。図示されるように、第1変形部11は、傾動部13の一方の側(図1及び図2における左方)で長手方向lと交差する方向に延在している。一方、第2変形部12は、傾動部13の他方の側(図1及び図2における右方)で長手方向lと交差する方向に延在している。図示される例では、長手方向lと交差する方向とは、X軸方向である。 In the present embodiment, as shown in FIGS. 1 and 2, the deformed body 10 has a longitudinal direction l parallel to the Z axis, and a tilting portion 13 arranged between the receiving portion 14 and the fixing portion 15. It has a first deforming portion 11 that connects the receiving force portion P and the tilting portion 13, and a second deforming portion 12 that connects the fixing portion 15 and the tilting portion 13. As shown, the first deformed portion 11 extends in a direction intersecting the longitudinal direction l on one side of the tilting portion 13 (left in FIGS. 1 and 2). On the other hand, the second deformed portion 12 extends in a direction intersecting the longitudinal direction l on the other side (right side in FIGS. 1 and 2) of the tilting portion 13. In the illustrated example, the direction intersecting the longitudinal direction l is the X-axis direction.

更に、第1変形部11と傾動部13との接続部位R1と、第2変形部12と傾動部13との接続部位R2とは、傾動部13の長手方向lにおいて位置が異なっている。具体的には、接続部位R1は、傾動部13のZ軸負側の端部(図1における下端部)の近傍に位置しており、接続部位R2は、傾動部13のZ軸正側の端部(図1における上端部)の近傍に位置している。 Further, the connection portion R1 between the first deformed portion 11 and the tilting portion 13 and the connecting portion R2 between the second deformed portion 12 and the tilting portion 13 are located at different positions in the longitudinal direction l of the tilting portion 13. Specifically, the connecting portion R1 is located near the end on the negative side of the Z-axis of the tilting portion 13 (the lower end portion in FIG. 1), and the connecting portion R2 is located on the positive side of the Z-axis of the tilting portion 13. It is located near the end (upper end in FIG. 1).

図1及び図2に示すように、受力部14及び固定部15は、共にZ軸と平行に延在している。受力部14、傾動部13及び固定部15の各上端部は、Z座標が互いに同一である。また、受力部14及び傾動部13の各下端部も、Z座標が互いに同一である。そして、受力部14の下端と傾動部13の下端とが、X軸と平行に延在する第1変形部11によって接続され、傾動部13の上端と固定部15の上端とが、X軸と平行に延在する第2変形部12によって接続されている。更に、固定部15は、その下端が、所定の間隔を空けて傾動部13に対向配置された支持体50に接続されている。 As shown in FIGS. 1 and 2, both the receiving portion 14 and the fixing portion 15 extend parallel to the Z axis. The Z coordinates of the upper end portions of the receiving portion 14, the tilting portion 13, and the fixed portion 15 are the same as each other. Further, the lower end portions of the receiving portion 14 and the tilting portion 13 also have the same Z coordinates. Then, the lower end of the receiving force portion 14 and the lower end of the tilting portion 13 are connected by the first deformed portion 11 extending in parallel with the X axis, and the upper end of the tilting portion 13 and the upper end of the fixed portion 15 are connected to the X axis. It is connected by a second deformed portion 12 extending in parallel with. Further, the lower end of the fixing portion 15 is connected to the support 50 which is arranged to face the tilting portion 13 at a predetermined interval.

変位体20は、図1及び図2に示すように、傾動部13の下端に取り付けられた接続体22を介して当該傾動部13に接続された梁21を有している。この梁21は、傾動部13の長手方向lと直交する方向に延在しており、Y軸方向から見て、左右対称の形状を有している。梁21は、変形体10の固定部15及び受力部14から離間しており、当該梁21の傾動(回動)が固定部15及び受力部14によって妨げられないようになっている。梁21には、当該梁21と接続体22との接続部位に関して対称的に、第1計測部位D1及び第2計測部位D2が規定されている。後述されるように、これら第1計測部位D1及び第2計測部位D2にそれぞれ容量素子が配置され、受力部14に作用した力が検出されることになる。 As shown in FIGS. 1 and 2, the displacement body 20 has a beam 21 connected to the tilting portion 13 via a connecting body 22 attached to the lower end of the tilting portion 13. The beam 21 extends in a direction orthogonal to the longitudinal direction l of the tilting portion 13, and has a symmetrical shape when viewed from the Y-axis direction. The beam 21 is separated from the fixing portion 15 and the receiving portion 14 of the deformed body 10, so that the tilting (rotation) of the beam 21 is not hindered by the fixing portion 15 and the receiving portion 14. The beam 21 is defined with a first measurement portion D1 and a second measurement portion D2 symmetrically with respect to the connection portion between the beam 21 and the connecting body 22. As will be described later, capacitive elements are arranged in the first measurement portion D1 and the second measurement portion D2, respectively, and the force acting on the receiving unit 14 is detected.

< 1−2. 基本構造の作用 >
次に、以上のような基本構造100の作用について説明する。
<1-2. Action of basic structure >
Next, the operation of the basic structure 100 as described above will be described.

図3は、受力部14にX軸正方向の力+Fxが作用したときの基本構造100の変形状態を示す概略正面図であり、図4は、受力部14にX軸負方向の力−Fxが作用したときの基本構造100の変形状態を示す概略正面図であり、図5は、受力部14にZ軸負方向の力−Fzが作用したときの基本構造100の変形状態を示す概略正面図であり、図6は、受力部14にZ軸正方向の力+Fzが作用したときの基本構造100の変形状態を示す概略正面図である。 FIG. 3 is a schematic front view showing a deformed state of the basic structure 100 when a force in the positive direction of the X-axis + Fx acts on the receiving portion 14, and FIG. 4 is a schematic front view showing a force in the negative direction of the X-axis on the receiving portion 14. FIG. 5 is a schematic front view showing a deformed state of the basic structure 100 when −Fx acts, and FIG. 5 shows a deformed state of the basic structure 100 when a force −Fz in the negative Z-axis direction acts on the receiving portion 14. FIG. 6 is a schematic front view showing a deformed state of the basic structure 100 when a force + Fz in the positive direction of the Z axis is applied to the receiving portion 14.

(1−2−1.力+Fxが作用した場合)
受力部14にX軸正方向の力+Fxが作用すると、傾動部13の下端近傍の接続部位R1にはX軸正方向(図3における右方向)に力が作用し、傾動部13の上端近傍の接続部位R2には、作用した力+Fxの反作用として、X軸負方向(図3における左方向)に力が作用する。これらの力の作用によって、図3に示すように、傾動部13は、反時計回りに傾動する。更に、作用した力+Fxの作用によって、第1変形部11及び第2変形部12は共に圧縮変形されるため、傾動部13は、全体として、わずかにX軸正方向に変位する。
(1-2-1. When force + Fx acts)
When a force + Fx in the positive direction of the X-axis acts on the receiving portion 14, a force acts on the connection portion R1 near the lower end of the tilting portion 13 in the positive direction of the X-axis (to the right in FIG. 3), and the upper end of the tilting portion 13 A force acts on the nearby connection portion R2 in the negative direction of the X-axis (left direction in FIG. 3) as a reaction of the applied force + Fx. Due to the action of these forces, the tilting portion 13 tilts counterclockwise as shown in FIG. Further, since the first deformed portion 11 and the second deformed portion 12 are both compressed and deformed by the action of the applied force + Fx, the tilted portion 13 is slightly displaced in the positive direction of the X axis as a whole.

このような傾動部13の傾動によって、図3に示すように、傾動部13の下端に接続された梁21も反時計回りに傾動する。これにより、梁21の第1計測部位D1は、支持体50との間の離間距離が減少する方向(図3における下方)に変位し、第2計測部位D2は、支持体50との間の離間距離が増大する方向(図3における上方)に変位する。 As shown in FIG. 3, the beam 21 connected to the lower end of the tilting portion 13 also tilts counterclockwise due to the tilting of the tilting portion 13. As a result, the first measurement portion D1 of the beam 21 is displaced in the direction in which the separation distance from the support 50 decreases (downward in FIG. 3), and the second measurement portion D2 is between the support 50 and the support 50. It is displaced in the direction in which the separation distance increases (upward in FIG. 3).

(1−2−2.力−Fxが作用した場合)
次に、受力部14にX軸負方向の力−Fxが作用すると、傾動部13の下端近傍の接続部位R1にはX軸負方向(図4における左方向)に力が作用し、傾動部13の上端近傍の接続部位R2には、作用した力−Fxの反作用として、X軸正方向(図4における右方向)に力が作用する。これらの力の作用によって、図4に示すように、傾動部13は、時計回りに傾動する。更に、作用した力−Fxの作用によって、第1変形部11及び第2変形部12は共に引張変形されるため、傾動部13は、全体として、わずかにX軸負方向に変位する。
(1-2-2. When force-Fx acts)
Next, when a force −Fx in the negative direction of the X-axis acts on the receiving portion 14, a force acts on the connection portion R1 near the lower end of the tilting portion 13 in the negative direction of the X-axis (left direction in FIG. 4) to tilt. A force acts on the connection portion R2 near the upper end of the portion 13 in the positive direction of the X-axis (right direction in FIG. 4) as a reaction of the applied force −Fx. Due to the action of these forces, the tilting portion 13 tilts clockwise as shown in FIG. Further, since the first deformed portion 11 and the second deformed portion 12 are both tension-deformed by the action of the applied force −Fx, the tilted portion 13 is slightly displaced in the negative direction of the X-axis as a whole.

このような傾動部13の傾動によって、図4に示すように、傾動部13の下端に接続された梁21も、時計回りに傾動する。これにより、梁21の第1計測部位D1は、支持体50との間の離間距離が増大する方向(図4における上方)に変位し、第2計測部位D2は、支持体50との間の離間距離が減少する方向(図4における下方)に変位する。
(1−2−3.力−Fzが作用した場合)
As shown in FIG. 4, the beam 21 connected to the lower end of the tilting portion 13 also tilts clockwise due to the tilting of the tilting portion 13. As a result, the first measurement portion D1 of the beam 21 is displaced in the direction in which the separation distance from the support 50 increases (upward in FIG. 4), and the second measurement portion D2 is between the support 50 and the support 50. It is displaced in the direction in which the separation distance decreases (downward in FIG. 4).
(1-2-3. When force-Fz acts)

次に、受力部14にZ軸負方向の力−Fzが作用すると、傾動部13の左下端の接続部位R1にはZ軸負方向(図5における下方向)に力が作用し、傾動部13の右上端の接続部位R2には、作用した力−Fzの反作用として、Z軸正方向(図5における上方向)に力が作用する。これらの力の作用によって、図5に示すように、傾動部13は、反時計回りに傾動する。更に、作用した力−Fzの作用によって、第1変形部11を介して傾動部13がZ軸負方向へ引き下げられるため、当該傾動部13は、全体として、わずかにZ軸負方向に変位する。 Next, when a force −Fz in the negative direction of the Z axis acts on the receiving portion 14, a force acts on the connection portion R1 at the lower left end of the tilting portion 13 in the negative direction of the Z axis (downward in FIG. 5) and tilts. A force acts on the connection portion R2 at the upper right end of the portion 13 in the positive direction of the Z axis (upward in FIG. 5) as a reaction of the applied force −Fz. Due to the action of these forces, the tilting portion 13 tilts counterclockwise as shown in FIG. Further, due to the action of the applied force −Fz, the tilting portion 13 is pulled down in the negative Z-axis direction via the first deforming portion 11, so that the tilting portion 13 is slightly displaced in the negative Z-axis direction as a whole. ..

傾動部13の傾動によって、図5に示すように、傾動部13の下端に接続された梁21も、反時計回りに傾動する。これにより、梁21の第1計測部位D1は、支持体50との間の離間距離が減少する方向(図5における下方)に変位し、第2計測部位D2は、支持体50との間の離間距離が増大する方向(図5における上方)に変位する。 As shown in FIG. 5, the beam 21 connected to the lower end of the tilting portion 13 also tilts counterclockwise due to the tilting of the tilting portion 13. As a result, the first measurement portion D1 of the beam 21 is displaced in the direction in which the separation distance from the support 50 decreases (downward in FIG. 5), and the second measurement portion D2 is between the support 50 and the support 50. It is displaced in the direction in which the separation distance increases (upward in FIG. 5).

なお、梁21の長さによっては、第2計測部位D2のZ軸正方向への変位が梁21全体のZ軸負方向への変位よりも小さくなり、第2計測部位D2も、支持体50との間の離間距離が減少する、ということも想定される。しかしながら、ここでは、梁21は十分な長さを有しており、そのような状況は生じないものとする。
(1−2−4.力+Fzが作用した場合)
Depending on the length of the beam 21, the displacement of the second measurement portion D2 in the positive direction of the Z axis becomes smaller than the displacement of the entire beam 21 in the negative direction of the Z axis, and the second measurement portion D2 is also supported by the support 50. It is also assumed that the distance between the and will decrease. However, here, it is assumed that the beam 21 has a sufficient length and such a situation does not occur.
(1-2-4. When force + Fz acts)

次に、受力部14にZ軸正方向の力+Fzが作用すると、傾動部13の左下端の接続部位R1にはZ軸正方向(図6における上方向)に力が作用し、傾動部13の右上端の接続部位R2には、作用した力+Fzの反作用として、Z軸負向(図6における下方向)に力が作用する。これらの力の作用によって、図6に示すように、傾動部13は、時計回りに傾動する。もちろん、作用した力+Fzの作用によって、第1変形部11を介して傾動部13がZ軸正方向へ引き上げられるため、当該傾動部13は、全体として、わずかにZ軸正方向に変位する。 Next, when a force + Fz in the positive direction of the Z axis acts on the receiving portion 14, a force acts on the connection portion R1 at the lower left end of the tilting portion 13 in the positive direction of the Z axis (upward in FIG. 6), and the tilting portion A force acts on the connection portion R2 at the upper right end of No. 13 in the negative direction of the Z axis (downward in FIG. 6) as a reaction of the applied force + Fz. Due to the action of these forces, the tilting portion 13 tilts clockwise as shown in FIG. Of course, due to the action of the applied force + Fz, the tilting portion 13 is pulled up in the Z-axis positive direction via the first deforming portion 11, so that the tilting portion 13 is slightly displaced in the Z-axis positive direction as a whole.

このような傾動部13の傾動によって、図6に示すように、傾動部13の下端に接続された梁21も、時計回りに傾動する。これにより、梁21の第1計測部位D1は、支持体50との間の離間距離が増大する方向(図6における上方)に変位し、第2計測部位D2は、支持体50との間の離間距離が減少する方向(図6おける下方)に変位する。 As shown in FIG. 6, the beam 21 connected to the lower end of the tilting portion 13 also tilts clockwise due to the tilting of the tilting portion 13. As a result, the first measurement portion D1 of the beam 21 is displaced in the direction in which the separation distance from the support 50 increases (upward in FIG. 6), and the second measurement portion D2 is between the support 50 and the support 50. Displace in the direction in which the separation distance decreases (downward in FIG. 6).

なお、梁21の長さによっては、第2計測部位D2のZ軸負方向への変位が梁21全体のZ軸正方向への変位よりも小さくなり、第2計測部位D2も、支持体50との間の離間距離が増大する、ということも想定される。しかしながら、ここでは、梁21は十分な長さを有しており、そのような状況は生じないものとする。 Depending on the length of the beam 21, the displacement of the second measurement portion D2 in the negative Z-axis direction becomes smaller than the displacement of the entire beam 21 in the positive Z-axis direction, and the second measurement portion D2 also has the support 50. It is also assumed that the separation distance from and will increase. However, here, it is assumed that the beam 21 has a sufficient length and such a situation does not occur.

以上のいずれの場合においても、第1計測部位D1及び第2計測部位D2に生じる変位は、傾動部13の下端に生じる変位よりも大きい。すなわち、梁21の存在によって、傾動部13の下端部に生じる変位が、梁21の各計測部位D1、D2においてZ軸方向の変位として増幅されて取り出されることになる。 In any of the above cases, the displacement generated in the first measurement portion D1 and the second measurement portion D2 is larger than the displacement generated in the lower end of the tilting portion 13. That is, due to the presence of the beam 21, the displacement generated at the lower end of the tilting portion 13 is amplified and taken out as the displacement in the Z-axis direction at the measurement sites D1 and D2 of the beam 21.

< 1−3. 力覚センサの構成 >
次に、1−1、1−2において説明した基本構造100を有する力覚センサ100cの構成について説明する。
<1-3. Force sensor configuration >
Next, the configuration of the force sensor 100c having the basic structure 100 described in 1-1 and 1-2 will be described.

図7は、図1に示す基本構造100を採用した力覚センサ100cの例を示す概略正面図であり、図8は、本実施の形態の力覚センサ100cに採用されている検出回路40のブロック図である。 FIG. 7 is a schematic front view showing an example of the force sensor 100c adopting the basic structure 100 shown in FIG. 1, and FIG. 8 shows the detection circuit 40 adopted in the force sensor 100c of the present embodiment. It is a block diagram.

図7に示すように、力覚センサ100cは、上述した基本構造100と、基本構造100の梁21の第1計測部位D1及び第2計測部位D2に生じる変位に基づいて、作用した力を検出する検出回路40と、を有している。本実施の形態の検出回路40は、図7に示すように、第1計測部位D1に配置された第1−1容量素子C11及び第1−2容量素子C12と、第2計測部位D2に配置された第2−1容量素子C21及び第2−2容量素子C22と、容量素子C11〜C22に接続され、当該容量素子C11〜C22の静電容量値の変動量に基づいて作用した力を計測し出力する機能を有している。図示されるように、第1−1容量素子C11及び第2−1容量素子C21は、梁21と接続体22との接続部位に関して対称的に配置されており、第1−2容量素子C12及び第2−2容量素子C22は、第1−1容量素子C11と第2−1容量素子C21との間に、当該接続部位に関して対称的に配置されている。 As shown in FIG. 7, the force sensor 100c detects the applied force based on the displacements generated in the above-mentioned basic structure 100 and the first measurement portion D1 and the second measurement portion D2 of the beam 21 of the basic structure 100. It has a detection circuit 40 and a detection circuit 40. As shown in FIG. 7, the detection circuit 40 of the present embodiment is arranged at the 1-1 capacitance element C11 and the 1-2 capacitance element C12 arranged at the first measurement portion D1 and at the second measurement portion D2. 2-1 Capacitance element C21 and 2-2 Capacitance element C22, connected to the capacitance elements C11 to C22, and the force acting based on the fluctuation amount of the capacitance value of the capacitance elements C11 to C22 is measured. It has a function to output. As shown, the 1-1 capacitive element C11 and the 2-1 capacitive element C21 are arranged symmetrically with respect to the connection portion between the beam 21 and the connecting body 22, and the 1-2 capacitive element C12 and The 2nd and 2nd capacitance elements C22 are arranged symmetrically with respect to the connection portion between the 1-1 capacitance element C11 and the 2-1 capacitance element C21.

図7に示すように、第1−1容量素子C11は、梁21の第1計測部位D1に絶縁体を介して配置された第1−1変位電極Em11と、支持体50上に絶縁体を介して第1−1変位電極Em11に対向して配置された第1−1固定電極Ef11と、を有している。第1−2容量素子C12は、梁21の第1計測部位D1に、第1−1容量素子C11に隣接して、絶縁体を介して配置された第1−2変位電極Em12と、支持体50上に絶縁体を介して第1−2変位電極Em12に対向して配置された第1−2固定電極Ef12と、を有している。なお、第1−1変位電極Em11及び第1−2変位電極Em12と、1−1固定電極Ef11及び1−2固定電極Ef12と、の一方が共通の電極で構成されていても良い。 As shown in FIG. 7, the 1-1 capacitance element C11 has an insulator on the support 50 and a 1-1 displacement electrode Em11 arranged on the first measurement portion D1 of the beam 21 via an insulator. It has a 1-1 fixed electrode Ef11 arranged so as to face the 1-1 displacement electrode Em11. The first and second capacitance elements C12 are arranged on the first measurement portion D1 of the beam 21 adjacent to the 1-1 capacitance element C11 via an insulator, and the first and second displacement electrodes Em12 and a support. It has a first and second fixed electrodes Ef12 arranged on the 50 so as to face the first and second displacement electrodes Em12 via an insulator. One of the 1-1 displacement electrode Em11 and the 1-2 displacement electrode Em12 and the 1-1 fixed electrode Ef11 and the 1-2 fixed electrode Ef12 may be configured by a common electrode.

更に、図7に示すように、第2−1容量素子C21は、梁21の第2計測部位D2に絶縁体を介して配置された第2−1変位電極Em21と、支持体50上に絶縁体を介して第2−1変位電極Em21に対向して配置された第2−1固定電極Ef21と、を有している。第2−2容量素子C22は、梁21の第2計測部位D2に、第2−1容量素子C21に隣接して、絶縁体を介して配置された第2−2変位電極Em22と、支持体50上に絶縁体を介して第2−2変位電極Em22に対向して配置された第2−2固定電極Ef22と、を有している。なお、第2−1変位電極Em21及び第2−2変位電極Em22と、2−1固定電極Ef21及び2−2固定電極Ef22と、の一方が共通の電極で構成されていても良い。 Further, as shown in FIG. 7, the 2-1 capacitance element C21 is insulated on the support 50 with the 2-1 displacement electrode Em21 arranged at the second measurement portion D2 of the beam 21 via an insulator. It has a 2-1 fixed electrode Ef21 arranged so as to face the 2-1 displacement electrode Em21 via a body. The 2nd to 2nd capacitance element C22 has a 2nd to 2nd displacement electrode Em22 arranged on the second measurement portion D2 of the beam 21 adjacent to the 2-1 capacitance element C21 via an insulator, and a support. It has a 2-2 fixed electrode Ef22 arranged on the 50 so as to face the 2-2 displacement electrode Em22 via an insulator. One of the 2-1 displacement electrode Em21 and the 2-2 displacement electrode Em22 and the 2-1 fixed electrode Ef21 and the 2-2 fixed electrode Ef22 may be configured by a common electrode.

また、図8に示すように、検出回路40は、各容量素子C11〜C22の静電容量値に対応する電気信号、をそれぞれ対応する電圧値に変換するC/V変換器42と、C/V変換器42から提供される電圧値に基づいて力覚センサ100cに作用している力Fx、Fzを算出するマイコン44と、を有している。マイコン44は、各容量素子C11〜C22の特性(面積、極板間距離、配置されている位置など)に基づいて、C/V変換器42から提供される電圧値を補正する補正回路、C/V変換器42から提供される電圧値に所定の差分演算を行い、力Fx、Fzに対応する複数の電気信号(後述されるFx1〜Fx3、Fz1〜Fz3に対応する電気信号)を生成する生成回路、これらの電気信号を互いに比較する比較回路、及び、比較回路による比較結果に基づいて力覚センサ100cが正常に機能しているか否かを診断する診断回路、を有している。 Further, as shown in FIG. 8, the detection circuit 40 includes a C / V converter 42 that converts an electric signal corresponding to the capacitance value of each of the capacitance elements C11 to C22 into a corresponding voltage value, and a C / V converter 42. It has a microcomputer 44 that calculates the forces Fx and Fz acting on the force sensor 100c based on the voltage value provided by the V converter 42. The microcomputer 44 is a correction circuit, C, which corrects the voltage value provided by the C / V converter 42 based on the characteristics (area, distance between plates, arranged position, etc.) of each of the capacitance elements C11 to C22. A predetermined difference calculation is performed on the voltage value provided by the / V converter 42 to generate a plurality of electric signals corresponding to the forces Fx and Fz (electric signals corresponding to Fx1 to Fx3 and Fz1 to Fz3 described later). It has a generation circuit, a comparison circuit for comparing these electric signals with each other, and a diagnostic circuit for diagnosing whether or not the force sensor 100c is functioning normally based on the comparison result by the comparison circuit.

容量素子C11〜C22は、図7には明確には図示されていないが、所定の回路によってC/V変換器42に接続されており、このC/V変換器42に接続されたマイコン44によって、各容量素子C11〜C22の静電容量値の変動量に基づき作用した力が計測されるようになっている。 Although the capacitive elements C11 to C22 are not clearly shown in FIG. 7, they are connected to the C / V converter 42 by a predetermined circuit, and are connected to the C / V converter 42 by the microcomputer 44 connected to the C / V converter 42. , The acting force is measured based on the fluctuation amount of the capacitance value of each capacitance element C11 to C22.

< 1−4. 力覚センサの作用 >
次に、1−3.で説明した力覚センサ100cの作用について説明する。図9は、力覚センサ100cに力Fx及びFzが作用した際の、各容量素子C11〜C22の静電容量値の変動を示す図表である。この図表において、「+」は、静電容量値が増大することを示しており、「++」は、静電容量値が大きく増大することを示している。また、「−」は、静電容量値が減少することを示しており、「−−」は、静電容量値が大きく減少することを示している。
<1-4. Action of force sensor >
Next, 1-3. The operation of the force sensor 100c described in the above will be described. FIG. 9 is a chart showing changes in the capacitance values of the capacitance elements C11 to C22 when the forces Fx and Fz act on the force sensor 100c. In this chart, "+" indicates that the capacitance value increases, and "++" indicates that the capacitance value increases significantly. Further, "-" indicates that the capacitance value decreases, and "-" indicates that the capacitance value decreases significantly.

(1−4−1.力Fxが作用した場合)
力覚センサ100cの受力部14にX軸正方向の力+Fxが作用すると、1−2.において図3を参照して説明した梁21の挙動から理解されるように、第1−1容量素子C11及び第1−2容量素子C12においては、変位電極Em11、Em12と対応する固定電極Ef11、Ef12との離間距離がそれぞれ減少する。一方、第2−1容量素子C21及び第2−2容量素子C22においては、変位電極Em21、Em22と対応する固定電極Ef21、Ef22との離間距離がそれぞれ増大する。したがって、第1−1容量素子C11及び第1−2容量素子C12の静電容量値は増大し、第2−1容量素子C21及び第2−2容量素子C22の静電容量値は減少する。また、傾動部13と梁21との接続部位から、すなわち梁21の傾動の中心から、各容量素子C11〜C22までの距離を考慮すると、第1−1容量素子C11及び第2−1容量素子C21の静電容量値の変動量は、第1−2容量素子C12及び第2−2容量素子C22の静電容量値の変動量よりも大きい。以上の結果は、図9のFzの欄に纏めて示してある。
(1-4-1. When force Fx acts)
When a force + Fx in the positive direction of the X-axis acts on the receiving portion 14 of the force sensor 100c, 1-2. As can be understood from the behavior of the beam 21 described with reference to FIG. 3, in the 1-1 capacitance element C11 and the 1-2 capacitance element C12, the displacement electrodes Em11, the fixed electrodes Ef11 corresponding to Em12, The separation distance from Ef12 is reduced. On the other hand, in the 2-1 capacitance element C21 and the 2-2 capacitance element C22, the separation distance between the displacement electrodes Em21 and Em22 and the corresponding fixed electrodes Ef21 and Ef22 increases, respectively. Therefore, the capacitance values of the 1-1 capacitance element C11 and the 1-2 capacitance element C12 increase, and the capacitance values of the 2-1 capacitance element C21 and the 2-2 capacitance element C22 decrease. Further, considering the distance from the connection portion between the tilting portion 13 and the beam 21, that is, from the center of tilting of the beam 21 to each capacitance element C11 to C22, the 1-1 capacitance element C11 and the 2-1 capacitance element The fluctuation amount of the capacitance value of C21 is larger than the fluctuation amount of the capacitance value of the first and second capacitance elements C12 and the second and second capacitance elements C22. The above results are summarized in the Fz column of FIG.

また、本実施の形態では、第1−1容量素子C11と第2−1容量素子C21とが梁21の傾動の中心から互いに等距離に配置され、第1−2容量素子C12と第2−2容量素子C22とが梁21の傾動の中心から互いに等距離に配置されている。このため、第1−1容量素子C11の静電容量値の変動の大きさ(|ΔC11|)と、第2−1容量素子C21の静電容量値の変動の大きさ(|ΔC21|)とが、互いに等しい。更に、第1−2容量素子C12の静電容量値の変動の大きさ(|ΔC12|)と、第2−2容量素子C22の静電容量値の変動の大きさ(|ΔC22|)とが、互いに等しい。このため、|ΔC11|=|ΔC21|=ΔC1、|ΔC12|=|ΔC22|=ΔC2とすると、力+Fxが作用したときの第1−1〜第2−2容量素子C11〜C11〜C22各静電容量値C11a〜C22aは、次の[式1]で表される。[式1]において、C11〜C22は、力が作用していないときの各容量素子C11〜C22の静電容量値をそれぞれ示している。なお、このような表記方法は、後続する各式において同様である。
[式1]
C11a=C11+ΔC1
C12a=C12+ΔC2
C21a=C21−ΔC1
C22a=C22−ΔC2
Further, in the present embodiment, the 1-1 capacitance element C11 and the 2-1 capacitance element C21 are arranged equidistant from the center of tilt of the beam 21, and the 1-2 capacitance element C12 and the second 2-capacity element C12 are arranged at equal distances from each other. The two-capacity element C22 is arranged equidistant from the center of tilt of the beam 21. Therefore, the magnitude of the fluctuation of the capacitance value of the 1-1 capacitance element C11 (| ΔC11 |) and the magnitude of the fluctuation of the capacitance value of the 2-1 capacitance element C21 (| ΔC21 |) But are equal to each other. Further, the magnitude of the fluctuation of the capacitance value of the first and second capacitance elements C12 (| ΔC12 |) and the magnitude of the fluctuation of the capacitance value of the second and second capacitance elements C22 (| ΔC22 |) are determined. , Equal to each other. Therefore, if | ΔC11 | = | ΔC21 | = ΔC1 and | ΔC12 | = | ΔC22 | = ΔC2, the static electricity of the 1st to 2nd 2nd capacitance elements C11 to C11 to C22 when the force + Fx is applied. The capacitance values C11a to C22a are represented by the following [Equation 1]. In [Equation 1], C11 to C22 represent the capacitance values of the capacitance elements C11 to C22 when no force is applied. In addition, such a notation method is the same in each subsequent expression.
[Equation 1]
C11a = C11 + ΔC1
C12a = C12 + ΔC2
C21a = C21-ΔC1
C22a = C22-ΔC2

このような静電容量値の変動に基づいて、マイコン44は、作用した力+Fxを次の[式2]に示す+Fx1〜+Fx3のいずれかにより計測する。末尾の数字「1」〜「3」は、+Fxの値がいずれの容量素子に基づいて計測されたかを区別するための符号である。もちろん、力覚センサ100cが正常に機能しているならば、+Fx1〜+Fx3は実質的に等しい値となる。また、[式2]において、力と静電容量値とが「=」で結ばれているが、これらは互いに異なる物理量であるため、実際には所定の変換がなされた上で力+Fxが計測される。この表記法については、[式2]に限らず、これ以降の各式において共通している。
[式2]
+Fx1=C11−C21
+Fx2=C12−C22
+Fx3==Fx1+Fx2=(C11+C12)−(C21+C22)
Based on such a fluctuation of the capacitance value, the microcomputer 44 measures the acting force + Fx by any of + Fx1 to + Fx3 shown in the following [Equation 2]. The numbers "1" to "3" at the end are codes for distinguishing which capacitive element the value of + Fx was measured based on. Of course, if the force sensor 100c is functioning normally, + Fx1 to + Fx3 will be substantially equal values. Further, in [Equation 2], the force and the capacitance value are connected by "=", but since these are physical quantities different from each other, the force + Fx is actually measured after a predetermined conversion is performed. Will be done. This notation is not limited to [Equation 2], but is common to all subsequent expressions.
[Equation 2]
+ Fx1 = C11-C21
+ Fx2 = C12-C22
+ Fx3 == Fx1 + Fx2 = (C11 + C12)-(C21 + C22)

なお、力覚センサ100cの受力部14にX軸負方向の力−Fxが作用した場合は、1−2.において図4を参照して説明した梁21の挙動から理解されるように、第1−1容量素子C11及び第1−2容量素子C12の静電容量値は減少し、第2−1容量素子C21及び第2−2容量素子C22の静電容量値は増大する。このため、作用した力−Fxを計測するには[式2]において符号を全て逆にすればよい。結局、X軸方向の力Fxの向きが正であれ負であれ、[式2]と同じ式で力Fxを計測することができる。 When a force-Fx in the negative direction of the X-axis acts on the receiving portion 14 of the force sensor 100c, 1-2. As can be understood from the behavior of the beam 21 described with reference to FIG. 4, the capacitance values of the 1-1 capacitance element C11 and the 1-2 capacitance element C12 decrease, and the 2-1 capacitance element decreases. The capacitance values of C21 and the 2nd-2nd capacitive element C22 increase. Therefore, in order to measure the applied force −Fx, all the symbols may be reversed in [Equation 2]. After all, regardless of whether the direction of the force Fx in the X-axis direction is positive or negative, the force Fx can be measured by the same equation as in [Equation 2].

力Fxを計測するに当たっては、S/Nの観点から、傾動部13の長手方向lから遠位にあり静電容量値の変動量が相対的に大きい容量素子C11、C21に基づくFx1の式、または、全ての容量素子C11〜C22に基づくFx3の式、を用いることが好ましい。 In measuring the force Fx, from the viewpoint of S / N, the equation of Fx1 based on the capacitive elements C11 and C21 located distal to the longitudinal direction l of the tilting portion 13 and having a relatively large fluctuation amount of the capacitance value, Alternatively, it is preferable to use the formula of Fx3 based on all the capacitive elements C11 to C22.

(1−4−2.力Fzが作用した場合)
次に、力覚センサ100cの受力部14にZ軸負方向の力−Fzが作用すると、1−2において図5を参照して説明した梁21の挙動から理解されるように、第1−1容量素子C11及び第1−2容量素子C12においては、変位電極Em11、Em12と対応する固定電極Ef11、Ef12との離間距離がそれぞれ減少し、第2−1容量素子C21及び第2−2容量素子C22においては、変位電極Em21、Em22と対応する固定電極Ef21、Ef22との離間距離がそれぞれ増大する。したがって、第1−1容量素子C11及び第1−2容量素子C12の静電容量値は増大し、第2−1容量素子C21及び第2−2容量素子C22の静電容量値は減少する。また、力Fxが作用した場合と同様に、第1−1容量素子C11及び第2−1容量素子C21の静電容量値の変動量は、第1−2容量素子C12及び第2−2容量素子C22の静電容量値の変動量よりも大きい。以上の結果は、図9のFzの欄に纏めて示してある。
(1-4-2. When force Fz acts)
Next, when a force −Fz in the negative direction of the Z axis acts on the force receiving portion 14 of the force sensor 100c, as can be understood from the behavior of the beam 21 described in 1-2 with reference to FIG. In the -1 capacitance element C11 and the 1-2 capacitance element C12, the separation distances between the displacement electrodes Em11 and Em12 and the corresponding fixed electrodes Ef11 and Ef12 are reduced, respectively, and the 2-1 capacitance elements C21 and the 2nd-2 are In the capacitive element C22, the separation distances between the displacement electrodes Em21 and Em22 and the corresponding fixed electrodes Ef21 and Ef22 are increased, respectively. Therefore, the capacitance values of the 1-1 capacitance element C11 and the 1-2 capacitance element C12 increase, and the capacitance values of the 2-1 capacitance element C21 and the 2-2 capacitance element C22 decrease. Further, as in the case where the force Fx acts, the fluctuation amount of the capacitance value of the 1-1 capacitance element C11 and the 2-1 capacitance element C21 is the same as that of the 1-2 capacitance element C12 and the 2-2 capacitance. It is larger than the fluctuation amount of the capacitance value of the element C22. The above results are summarized in the Fz column of FIG.

より詳細には、力−Fzが作用したときに第1計測部位D1に生じる変位は、前述した傾動部13の全体的なZ軸負方向への変位と、梁21の傾動によるZ軸負方向への変位と、の和であり、第2計測部位D2に生じる変位は、傾動部13の当該変位と、梁21の傾動によるZ軸正方向への変位と、の和である。つまり、各容量素子C11〜C22の静電容量値の変動についてより正確に記述すれば、第1−1容量素子C11及び第1−2容量素子C12においては、梁21の傾動により第1計測部位D1に生じる変位に傾動部13の全体的なZ軸負方向への変位が加わるため、変位電極Em11、Em12と固定電極Ef11、Ef12との離間距離はそれぞれ大きく減少する。一方、第2−1容量素子C21及び第2−2容量素子C22においては、梁21の傾動により第2計測部位D2に生じる変位が傾動部13の全体的なZ軸負方向への変位によって相殺されるため、変位電極Em21、Em22と固定電極Ef21、Ef22との離間距離はそれぞれ僅かに増大する。 More specifically, the displacements that occur in the first measurement portion D1 when the force −Fz is applied are the displacement of the tilting portion 13 in the overall negative direction of the Z axis and the negative direction of the Z axis due to the tilting of the beam 21. The displacement that occurs in the second measurement portion D2 is the sum of the displacement of the tilting portion 13 and the displacement of the beam 21 in the positive direction of the Z axis due to the tilting of the beam 21. That is, if the fluctuation of the capacitance value of each capacitance element C11 to C22 is described more accurately, in the 1-1 capacitance element C11 and the 1-2 capacitance element C12, the first measurement site is due to the tilt of the beam 21. Since the displacement of the tilting portion 13 in the negative direction of the Z axis is added to the displacement generated in D1, the separation distances between the displacement electrodes Em11 and Em12 and the fixed electrodes Ef11 and Ef12 are greatly reduced, respectively. On the other hand, in the 2-1 capacitance element C21 and the 2-2 capacitance element C22, the displacement generated in the second measurement portion D2 due to the tilt of the beam 21 is offset by the overall displacement of the tilt portion 13 in the negative direction of the Z axis. Therefore, the separation distances between the displacement electrodes Em21 and Em22 and the fixed electrodes Ef21 and Ef22 are slightly increased, respectively.

但し、ここでは、簡単のため梁21の長さが十分に大きいものとしているため、傾動部13の全体的なZ軸方向への変位を無視して考えることができる。このため、マイコン44は、作用した力−Fzを次の[式3]により計測する。
[式3]
−Fz1=C11−C21
−Fz2=C12−C22
−Fz3=(−Fz1)+(−Fz2)=(C11+C12)−(C21+C22)
However, since the length of the beam 21 is made sufficiently large here for the sake of simplicity, the overall displacement of the tilting portion 13 in the Z-axis direction can be ignored. Therefore, the microcomputer 44 measures the acting force −Fz by the following [Equation 3].
[Equation 3]
-Fz1 = C11-C21
-Fz2 = C12-C22
-Fz3 = (-Fz1) + (-Fz2) = (C11 + C12)-(C21 + C22)

なお、力覚センサ100cの受力部14にZ軸正方向の力+Fzが作用した場合は、1−2.において図6を参照して説明した梁21の挙動から理解されるように、第1−1容量素子C11及び第1−2容量素子C12の静電容量値は減少し、第2−1容量素子C21及び第2−2容量素子C22の静電容量値は増大する。このため、作用した力+Fzを計測するには[式3]において符号を全て逆にすればよい。結局、Z軸方向の力Fzの向きが正であれ負であれ、[式3]と同じ式で力Fzを計測することができる。 When a force + Fz in the positive direction of the Z axis acts on the force receiving portion 14 of the force sensor 100c, 1-2. As can be understood from the behavior of the beam 21 described with reference to FIG. 6, the capacitance values of the 1-1 capacitance element C11 and the 1-2 capacitance element C12 decrease, and the 2-1 capacitance element The capacitance values of C21 and the 2nd-2nd capacitive element C22 increase. Therefore, in order to measure the acting force + Fz, all the symbols may be reversed in [Equation 3]. After all, regardless of whether the direction of the force Fz in the Z-axis direction is positive or negative, the force Fz can be measured by the same equation as in [Equation 3].

ここで、[式2]と[式3]とを比較すると、+Fxと−Fzの右辺が同一であることが分かる。したがって、本実施の形態による力覚センサ100cは、作用した力が+Fxであるのか−Fzであるのかを識別することができない。すなわち、力覚センサ100cは、作用した力の方向を識別することができない。このため、力覚センサ100cは、作用する力がX軸方向またはZ軸方向の一方向のみに限定されている環境において好適に利用され得る。 Here, when [Equation 2] and [Equation 3] are compared, it can be seen that the right sides of + Fx and −Fz are the same. Therefore, the force sensor 100c according to the present embodiment cannot distinguish whether the applied force is + Fx or −Fz. That is, the force sensor 100c cannot identify the direction of the applied force. Therefore, the force sensor 100c can be suitably used in an environment in which the acting force is limited to only one direction in the X-axis direction or the Z-axis direction.

力Fzを計測するに当たっては、S/Nの観点から、傾動部13の長手方向lから遠位にあり静電容量値の変動量が相対的に大きい容量素子C11、C21に基づくFz1の式、または、全ての容量素子C11〜C22に基づくFz3の式、を用いることが好ましい。 In measuring the force Fz, from the viewpoint of S / N, the equation of Fz1 based on the capacitive elements C11 and C21 located distal to the longitudinal direction l of the tilting portion 13 and having a relatively large fluctuation amount of the capacitance value, Alternatively, it is preferable to use the formula of Fz3 based on all the capacitive elements C11 to C22.

< 1−5. 故障診断 >
本実施の形態の検出回路40は、力覚センサ100cが正常に機能しているか否かを判定する機能を有している。ここでは、この故障診断の機能について説明を行う。
<1-5. Failure diagnosis >
The detection circuit 40 of the present embodiment has a function of determining whether or not the force sensor 100c is functioning normally. Here, the function of this failure diagnosis will be described.

本実施の形態の検出回路40のマイコン44は、第1−1容量素子C11の静電容量値の変動量と第1−2容量素子C12の静電容量値の変動量との差に基づく第1電気信号T1と、第2−1容量素子C21の静電容量値の変動量と第2−2容量素子C22の静電容量値の変動量との差に基づく第2電気信号T2と、第1電気信号T1と第2電気信号T2との和である合算電気信号T3を出力するようになっている。すなわち、第1電気信号T1は、上述した力Fx1及びFz1を示す電気信号であり、第2電気信号T2は、上述したFx2及びFz2を示す電気信号であり、合算電気信号は、上述した力Fx3及びFz3を示す電気信号である。第1電気信号T1、第2電気信号T2及び合算電気信号T3を書き下すと、次の[式4]の通りである。
[式4]
T1=C11−C21
T2=C12−C22
T3=T1+T2=(C11+C12)−(C21+C22)
The microcomputer 44 of the detection circuit 40 of the present embodiment is based on the difference between the fluctuation amount of the capacitance value of the 1-1 capacitance element C11 and the fluctuation amount of the capacitance value of the 1-2 capacitance element C12. The first electric signal T1 and the second electric signal T2 based on the difference between the fluctuation amount of the capacitance value of the 2-1 capacitance element C21 and the fluctuation amount of the capacitance value of the 2-2 capacitance element C22, and the second The total electric signal T3, which is the sum of the first electric signal T1 and the second electric signal T2, is output. That is, the first electric signal T1 is an electric signal indicating the above-mentioned forces Fx1 and Fz1, the second electric signal T2 is an electric signal indicating the above-mentioned Fx2 and Fz2, and the total electric signal is the above-mentioned force Fx3. And an electric signal indicating Fz3. The following [Equation 4] is obtained by writing down the first electric signal T1, the second electric signal T2, and the total electric signal T3.
[Equation 4]
T1 = C11-C21
T2 = C12-C22
T3 = T1 + T2 = (C11 + C12)-(C21 + C22)

ところで、図9に示すように、第1−1容量素子C11及び第2−1容量素子C21の静電容量値の変動量は、第1−2容量素子C12及び第2−2容量素子C22の静電容量値の変動量よりも大きい。このため、例えばマイコン44の補正回路によって、第2電気信号T2に所定の補正係数kを乗じることによって、第1電気信号T1と第2電気信号T2の出力レベルを揃えることができる。 By the way, as shown in FIG. 9, the fluctuation amount of the capacitance value of the 1-1 capacitance element C11 and the 2-1 capacitance element C21 is the fluctuation amount of the 1-2 capacitance element C12 and the 2-2 capacitance element C22. It is larger than the fluctuation amount of the capacitance value. Therefore, for example, the output levels of the first electric signal T1 and the second electric signal T2 can be made uniform by multiplying the second electric signal T2 by a predetermined correction coefficient k by the correction circuit of the microcomputer 44.

そして、マイコン44に含まれる比較回路がこれら2つの電気信号T1、k・T2を比較する。この比較は、差各信号T1、k・T2の差(例:T1−k・T2)、あるいは、各信号T1、k・T2の比(例:T1/(k・T2))に基づいて行われる。そして、2つの電気信号T1、k・T2の比較の結果、T1とk・T2との差または比が所定の範囲に含まれていれば、マイコン44の診断回路は、力覚センサ100cが正常に機能していると判定する。一方、T1とk・T2との差または比が所定の範囲に含まれていなければ、マイコン44の診断回路は、力覚センサ100cが正常に機能していない(故障している)と判定し、その判定結果を故障診断信号として出力する。このような検出回路40を有していれば、容量素子C11〜C22を構成する電極の破損、短絡、異物の混入などの異常を単一の力覚センサ100cによって検知することができる。 Then, the comparison circuit included in the microcomputer 44 compares these two electric signals T1 and k · T2. This comparison is based on the difference between the differences signals T1 and k · T2 (eg T1-k · T2) or the ratio of the signals T1 and k · T2 (eg T1 / (k · T2)). Be told. Then, as a result of comparing the two electric signals T1 and k / T2, if the difference or ratio between T1 and k / T2 is within a predetermined range, the diagnostic circuit of the microcomputer 44 has a normal force sensor 100c. Judge that it is functioning. On the other hand, if the difference or ratio between T1 and k / T2 is not included in the predetermined range, the diagnostic circuit of the microcomputer 44 determines that the force sensor 100c is not functioning normally (it is out of order). , The determination result is output as a failure diagnosis signal. If such a detection circuit 40 is provided, abnormalities such as breakage, short circuit, and foreign matter contamination of the electrodes constituting the capacitive elements C11 to C22 can be detected by a single force sensor 100c.

もちろん、各容量素子C11〜C22の静電容量値の変動量をAD変換し、マイコン44によって各静電容量値を比較することによって、力覚センサ100cの故障を診断しても良い。 Of course, the failure of the force sensor 100c may be diagnosed by AD-converting the fluctuation amount of the capacitance values of the capacitance elements C11 to C22 and comparing the capacitance values with the microcomputer 44.

以上のような本実施の形態によれば、第1−1容量素子C11及び第2−1容量素子C21の静電容量値の変動量に基づく第1電気信号T1と、第1−2容量素子C12及び第2−2容量素子C22の静電容量値の変動量に基づく第2電気信号T2と、を比較することにより、力覚センサ100cの故障を診断することができる。もちろん、これに代えて上述した合算電気信号T3と、第1電気信号T1及び第2電気信号T2の一方と、を比較しても、力覚センサ100cの故障を診断することができる。更に、力覚センサ100cにおいては、傾動部13の傾動によって各計測部位D1、D2が変位することにより、傾動部13に生じる傾動を効果的に増幅させることができる。以上のことから、本実施の形態によれば、低価格且つ高感度でありながら、単一の力覚センサ100cによってそれ自身の故障診断が可能である、という力覚センサ100cを提供することができる。 According to the present embodiment as described above, the first electric signal T1 based on the fluctuation amount of the capacitance value of the 1-1 capacitance element C11 and the 2-1 capacitance element C21 and the 1-2 capacitance element By comparing C12 with the second electric signal T2 based on the fluctuation amount of the capacitance value of the 2nd-2nd capacitive element C22, the failure of the force sensor 100c can be diagnosed. Of course, instead of this, the failure of the force sensor 100c can be diagnosed by comparing the above-mentioned total electric signal T3 with one of the first electric signal T1 and the second electric signal T2. Further, in the force sensor 100c, the tilting of the tilting portion 13 can effectively amplify the tilting caused by the displacement of the measurement portions D1 and D2 due to the tilting of the tilting portion 13. From the above, according to the present embodiment, it is possible to provide a force sensor 100c that can diagnose its own failure by a single force sensor 100c while being inexpensive and highly sensitive. can.

また、本実施の形態によれば、[式2]及び[式3]に示すように、検出回路40が静電容量値の差分によって作用した力Fx、Fzを計測するため、使用環境の温度変化や同相ノイズの影響を受けにくい力覚センサ100cを提供することができる。 Further, according to the present embodiment, as shown in [Equation 2] and [Equation 3], the detection circuit 40 measures the forces Fx and Fz acted by the difference in the capacitance value, so that the temperature of the usage environment is used. It is possible to provide a force sensor 100c that is not easily affected by changes and in-phase noise.

また、変位体20の第1計測部位D1及び第2計測部位D2は、梁21に接続体22と梁21との接続部位に関して対称的に配置されている。このため、第1計測部位D1に生じる変位と第2計測部位D2に生じる変位とが、同じ大きさで互いに異符号となるため、作用した力が簡易な演算によって検出され得る。 Further, the first measurement portion D1 and the second measurement portion D2 of the displacement body 20 are symmetrically arranged on the beam 21 with respect to the connection portion between the connecting body 22 and the beam 21. Therefore, since the displacement generated at the first measurement site D1 and the displacement generated at the second measurement site D2 have the same magnitude and different signs from each other, the applied force can be detected by a simple calculation.

また、検出回路40は、第1電気信号T1または合算電気信号T3に基づいて、作用した力を検出するため、S/Nに優れた力の検出が可能である。 Further, since the detection circuit 40 detects the acting force based on the first electric signal T1 or the total electric signal T3, it is possible to detect the force having excellent S / N.

< 1−6. 変形例 >
なお、以上の力覚センサ100cは、変位体20が両持ち梁の構造を有していたが、これに代えて片持ち梁の構造を有していても良い。そのような例が図58に示されている。図58は、変位体20が片持ち梁の構造を有する、図7の変形例による力覚センサ105cの概略正面図である。図58に示す例では、変位体20pが、上述した力覚センサ100cの梁21のうち、第2計測部位D2が規定されている側の部分が欠落した片持ち梁の構造(符号21p)を有している。この他の構成は、図7に示す力覚センサ100cと同じであるため、図58において、力覚センサ100cと共通する構成に図7と同じ符号を付し、ここではその詳細な説明を省略する。
<1-6. Modification example >
In the above force sensor 100c, the displacement body 20 has a double-sided beam structure, but instead of this, a cantilever structure may be provided. An example of such is shown in FIG. FIG. 58 is a schematic front view of the force sensor 105c according to the modified example of FIG. 7, in which the displacement body 20 has a cantilever structure. In the example shown in FIG. 58, the displacement body 20p has a cantilever structure (reference numeral 21p) in which the portion of the beam 21 of the force sensor 100c described above on the side where the second measurement portion D2 is defined is missing. Have. Since the other configurations are the same as those of the force sensor 100c shown in FIG. 7, in FIG. 58, the configurations common to the force sensor 100c are designated by the same reference numerals as those in FIG. 7, and detailed description thereof will be omitted here. do.

このような力覚センサ105cでは、上述した[式2]〜[式4]においてC21=C22=0とすることにより、力覚センサ105cに作用した力を検出でき、更には、力覚センサ105cの故障診断を行うことが可能である。但し、図58に示す力覚センサ105cは、作用した力Fx、Fzを容量素子の静電容量値の差によって検出することができない。このため、力覚センサ105cは、使用環境における温度変化や同相ノイズの影響を受けやすい点に注意が必要である。 In such a force sensor 105c, by setting C21 = C22 = 0 in the above-mentioned [Equation 2] to [Equation 4], the force acting on the force sensor 105c can be detected, and further, the force sensor 105c can be detected. It is possible to perform failure diagnosis. However, the force sensor 105c shown in FIG. 58 cannot detect the acting forces Fx and Fz due to the difference in the capacitance value of the capacitance element. Therefore, it should be noted that the force sensor 105c is easily affected by temperature changes and in-phase noise in the usage environment.

<<< §2. 本発明の第2の実施の形態による力覚センサ >>>
< 2−1. 基本構造の構成 >
図10は、本発明の第2の実施の形態による力覚センサ200cの基本構造200を示す概略正面図である。ここでも、図1と同様にXYZ三次元座標系を定義して以下の説明を行う。
<<< §2. Force sensor according to the second embodiment of the present invention >>>
<2-1. Structure of basic structure >
FIG. 10 is a schematic front view showing the basic structure 200 of the force sensor 200c according to the second embodiment of the present invention. Here, as in FIG. 1, the XYZ three-dimensional coordinate system is defined and the following description is given.

図10に示すように、本実施の形態の基本構造200は、受力部214と固定部215とを有し、受力部214に作用した力により弾性変形を生じる変形体210を備えている。変形体210は、長手方向la、lbを有し、受力部214と固定部215との間に受力部214から固定部215に向かって順次配置された第1傾動部213a及び第2傾動部213bと、第1傾動部213aと前記第2傾動部213bとの間に配置された力伝達部216と、を有している。そして、受力部214と第1傾動部213aとは、第1−1変形部211aによって接続されており、力伝達部216と第1傾動部213aは、第1−2変形部212aによって接続されている。更に、力伝達部216と第2傾動部213bとは、第2−1変形部211bによって接続されており、固定部215と第2傾動部213bとは、第2−2変形部212bによって接続されている。 As shown in FIG. 10, the basic structure 200 of the present embodiment includes a receiving portion 214 and a fixing portion 215, and includes a deformed body 210 that elastically deforms due to a force acting on the receiving portion 214. .. The deformed body 210 has la and lb in the longitudinal direction, and the first tilting portion 213a and the second tilting portion 213a and the second tilting portion 213a and the second tilting portion 210 which are sequentially arranged between the receiving portion 214 and the fixing portion 215 from the receiving portion 214 toward the fixed portion 215. It has a portion 213b and a force transmitting portion 216 arranged between the first tilting portion 213a and the second tilting portion 213b. The force receiving portion 214 and the first tilting portion 213a are connected by the 1-1 deforming portion 211a, and the force transmitting portion 216 and the first tilting portion 213a are connected by the 1-2 deforming portion 212a. ing. Further, the force transmitting portion 216 and the second tilting portion 213b are connected by the 2-1 deforming portion 211b, and the fixing portion 215 and the second tilting portion 213b are connected by the 2-2 deforming portion 212b. ing.

各変形部211a〜212bは、それぞれ、各傾動部213a、213bの長手方向la、lbと交差する方向に延在し、第1−1変形部211aと第1傾動部213aとの接続部位R1aと、第1−2変形部212aと第1傾動部213aとの接続部位R2aとは、第1傾動部213aの長手方向laにおいて位置が異なっている。更に、第2−1変形部211bと第2傾動部213bとの接続部位R1bと、第2−2変形部212bと第2傾動部213bの接続部位R2bとは、当該第2傾動部213bの長手方向lbにおいて位置が異なっている。 The deformed portions 211a to 212b extend in a direction intersecting the longitudinal directions la and lb of the tilting portions 213a and 213b, respectively, and are connected to the connection portion R1a between the first deforming portion 211a and the first tilting portion 213a. , The connection portion R2a between the 1-2 deformed portion 212a and the first tilting portion 213a is different in position in the longitudinal direction la of the first tilting portion 213a. Further, the connection portion R1b between the second deformed portion 211b and the second tilting portion 213b and the connecting portion R2b between the second deformed portion 212b and the second tilting portion 213b are the lengths of the second tilting portion 213b. The positions are different in the direction lb.

また、変形体210は、第1−1変形部211a及び第1−2変形部212aのバネ定数と、第2−1変形部211b及び第2−2変形部212bのバネ定数とが、異なっている。本実施の形態では、図10に示すように、第1−1変形部211a及び第1−2変形部212aが、第2−1変形部211b及び第2−2変形部212bよりも薄く形成されている。これにより、第1−1変形部211a及び第1−2変形部212aのバネ定数が、第2−1変形部211b及び第2−2変形部212bのバネ定数よりも小さくなっている。 Further, in the deformed body 210, the spring constants of the 1-1 deformed portion 211a and the 1-2 deformed portion 212a are different from the spring constants of the 2-1 deformed portion 211b and the 2-2 deformed portion 212b. There is. In the present embodiment, as shown in FIG. 10, the 1-1 deformed portion 211a and the 1-2 deformed portion 212a are formed thinner than the 2-1 deformed portion 211b and the 2-2 deformed portion 212b. ing. As a result, the spring constants of the 1-1 deformed portion 211a and the 1-2 deformed portion 212a are smaller than the spring constants of the 2-1 deformed portion 211b and the 2-2 deformed portion 212b.

図10に示すように、変位体220a、220bは、固定部215から離間し第1傾動部213aの傾動により変位する第1変位部と、固定部215から離間し第2傾動部213bの傾動により変位する第2変位部と、を有している。本実施の形態では、第1変位部は、第1傾動部213aの長手方向laと交差する方向に延在する第1梁221aとして構成され、第2変位部は、第2傾動部213bの長手方向lbと交差する方向に延在する第2梁221bとして構成されている。そして、図10に示すように、第1梁221aには第1−1計測部位D11及び第1−2計測部位D12が規定され、第2梁221bには、第2−1計測部位D21及び第2−2計測部位D22が規定されている。 As shown in FIG. 10, the displacement bodies 220a and 220b are separated from the fixed portion 215 and displaced by the tilt of the first tilting portion 213a, and separated from the fixed portion 215 by the tilting of the second tilting portion 213b. It has a second displacement portion that is displaced. In the present embodiment, the first displacement portion is configured as the first beam 221a extending in the direction intersecting the longitudinal direction la of the first tilt portion 213a, and the second displacement portion is the longitudinal length of the second tilt portion 213b. It is configured as a second beam 221b extending in a direction intersecting the direction lb. Then, as shown in FIG. 10, the first beam 221a defines the 1-1 measurement site D11 and the 1-2 measurement site D12, and the second beam 221b defines the 2-1 measurement site D21 and the first measurement site D12. 2-2 The measurement site D22 is defined.

具体的には、第1変位体220aは、変形体210の第1傾動部213aと第1梁221aとを接続する第1接続体222aを有し、第2変位体220bは、変形体210の第2傾動部213bと第2梁221bとを接続する第2接続体222bを有している。そして、第1梁221aの第1−1計測部位D11及び第1−2計測部位D12は、第1接続体222aと第1梁221aとの接続部位に関して対称的に配置されている。更に、第2梁221bの第2−1計測部位D12及び第2−2計測部位D22は、第2接続体222bと第2梁221bとの接続部位に関して対称的に配置されている。後述されるように、これらの計測部位D11〜D22に変位センサが配置され、この変位センサを用いて受力部214に作用した力が検出されることになる。 Specifically, the first displacement body 220a has a first connection body 222a that connects the first tilting portion 213a of the deformation body 210 and the first beam 221a, and the second displacement body 220b is the deformation body 210. It has a second connecting body 222b that connects the second tilting portion 213b and the second beam 221b. The 1-1 measurement portion D11 and the 1-2 measurement portion D12 of the first beam 221a are arranged symmetrically with respect to the connection portion between the first connecting body 222a and the first beam 221a. Further, the 2-1 measurement portion D12 and the 2-2 measurement portion D22 of the second beam 221b are arranged symmetrically with respect to the connection portion between the second connecting body 222b and the second beam 221b. As will be described later, displacement sensors are arranged at these measurement sites D11 to D22, and the force acting on the receiving unit 214 is detected by using the displacement sensors.

別言すると、本実施の形態の基本構造200は、図1に示す基本構造100を2つ用意し、一方の基本構造100の固定部15と他方の基本構造100の受力部14とが重なるようにして直列に配置した構造を有している。 In other words, in the basic structure 200 of the present embodiment, two basic structures 100 shown in FIG. 1 are prepared, and the fixed portion 15 of one basic structure 100 and the receiving portion 14 of the other basic structure 100 overlap each other. It has a structure arranged in series in this way.

< 2−2. 基本構造の作用 >
次に、図10に示す基本構造200の作用について説明する。
<2-2. Action of basic structure >
Next, the operation of the basic structure 200 shown in FIG. 10 will be described.

受力部214にX軸方向の力Fxが作用すると、この力Fxは、第1−1変形部211a、第1傾動部213a及び第1−2変形部212aを介して力伝達部216に伝達される。すなわち、力伝達部216にも、X軸方向の力Fxが作用する。また、受力部214にZ軸方向の力Fzが作用すると、この力Fzは、同様にして力伝達部216に伝達される。すなわち、力伝達部216にも、Z軸方向の力Fzが作用する。 When a force Fx in the X-axis direction acts on the force receiving portion 214, this force Fx is transmitted to the force transmitting portion 216 via the first deformed portion 211a, the first tilting portion 213a, and the 1-2 deformed portion 212a. Will be done. That is, the force Fx in the X-axis direction also acts on the force transmission unit 216. Further, when a force Fz in the Z-axis direction acts on the force receiving unit 214, this force Fz is similarly transmitted to the force transmitting unit 216. That is, the force Fz in the Z-axis direction also acts on the force transmission unit 216.

このため、受力部214にX軸正方向の力+Fxが作用した際に第1−1計測部位D11及び第2−1計測部位D12に生じるZ軸方向の変位は、第1の実施の形態の受力部14にX軸正方向の力+Fxが作用した際に第1計測部位D1及び第2計測部位D2に生じるZ軸方向の変位と、それぞれ同じ方向である。このことは、第2−1計測部位D21及び第2−2計測部位D22に生じるZ軸方向の変位についても成立する。但し、前述したように第1−1変形部211a及び第1−2変形部212aのバネ定数が第2−1変形部211b及び第2−2変形部212bのバネ定数よりも小さいため、第1−1計測部位D11及び第2−1計測部位D12に生じるZ軸方向の変位は、第2−1計測部位D21及び第2−2計測部位D22に生じるZ軸方向の変位より大きい。 Therefore, the displacement in the Z-axis direction that occurs in the 1-1 measurement portion D11 and the 2-1 measurement portion D12 when the force + Fx in the positive direction of the X-axis acts on the receiving portion 214 is the first embodiment. It is the same direction as the displacement in the Z-axis direction that occurs in the first measurement portion D1 and the second measurement portion D2 when the force + Fx in the positive direction of the X-axis acts on the force receiving portion 14. This also holds true for the displacement in the Z-axis direction that occurs at the 2-1 measurement site D21 and the 2-2 measurement site D22. However, as described above, since the spring constants of the 1-1 deformed portion 211a and the 1-2 deformed portion 212a are smaller than the spring constants of the 2-1 deformed portion 211b and the 2-2 deformed portion 212b, the first The Z-axis displacement that occurs at the -1 measurement site D11 and the 2-1 measurement site D12 is larger than the Z-axis displacement that occurs at the 2-1 measurement site D21 and the 2-2 measurement site D22.

更に、受力部214にZ軸負方向の力−Fzが作用した際に第1−1計測部位D11及び第2−1計測部位D12に生じるZ軸方向の変位は、第1の実施の形態の受力部14にZ軸負方向の力−Fxが作用した際に第1計測部位D1及び第2計測部位D2に生じるZ軸方向の変位と、それぞれ同じ方向である。このことは、第2−1計測部位D21及び第2−2計測部位D22に生じるZ軸方向の変位についても成立する。なお、図10から理解されるように、受力部214にZ軸方向の力Fzが作用した際に、第1傾動部213aは、第1−2変形部212a、第2−1変形部211b及び第2−2変形部212bにそれぞれ生じる撓み変形によってZ軸方向に変位する。一方、第1の実施の形態では、受力部14にZ軸方向の力Fzが作用した際に、傾動部13は、第2変形部12に生じる撓み変形によってのみ、Z軸方向に変位する。したがって、本実施の形態による基本構造200では、受力部214にZ軸方向の力Fzが作用した際に、第1傾動部213aのZ軸方向への変位が第1−1計測部位D11及び第2−1計測部位D12のZ軸方向への変位に与える影響は、第1の実施の形態より大きい。但し、ここでも、簡単のため各梁221a、221bが十分に長く、各傾動部13a、213bの全体的なZ軸方向への変位を無視して考えることとする。 Further, the displacement in the Z-axis direction that occurs in the 1-1 measurement portion D11 and the 2-1 measurement portion D12 when a force −Fz in the negative Z-axis direction acts on the receiving portion 214 is the first embodiment. This is the same direction as the displacement in the Z-axis direction that occurs in the first measurement portion D1 and the second measurement portion D2 when a force −Fx in the negative direction of the Z axis acts on the force receiving portion 14. This also holds true for the displacement in the Z-axis direction that occurs at the 2-1 measurement site D21 and the 2-2 measurement site D22. As can be understood from FIG. 10, when the force Fz in the Z-axis direction acts on the force receiving portion 214, the first tilting portion 213a becomes the 1-2 deformed portion 212a and the 2-1 deformed portion 211b. And 2-2, it is displaced in the Z-axis direction due to the bending deformation that occurs in the deformed portion 212b, respectively. On the other hand, in the first embodiment, when the force Fz in the Z-axis direction acts on the receiving portion 14, the tilting portion 13 is displaced in the Z-axis direction only by the bending deformation that occurs in the second deforming portion 12. .. Therefore, in the basic structure 200 according to the present embodiment, when the force Fz in the Z-axis direction acts on the receiving portion 214, the displacement of the first tilting portion 213a in the Z-axis direction is the 1-1 measurement portion D11 and The influence of the second 2-1 measurement site D12 on the displacement in the Z-axis direction is larger than that of the first embodiment. However, here as well, for the sake of simplicity, the beams 221a and 221b are sufficiently long, and the overall displacement of the tilting portions 13a and 213b in the Z-axis direction is ignored.

以上の考察の結果は、図11に纏めて示されている。図11は、X軸正方向の力+Fx及びZ軸負方向の力−Fzが受力部214に作用したときに、各計測部位D11〜D22に生じるZ軸方向の変位を纏めて示す図表である。図11において、「+」は、Z軸正方向に変位することを示しており、「++」は、Z軸方向に大きく変位することを示している。また、「−」は、Z軸負方向に変位することを示しており、「−−」は、Z軸負方向に大きく変位することを示している。なお、作用する力の向きが逆になった場合には、それぞれの正負が逆になる。 The results of the above considerations are summarized in FIG. FIG. 11 is a chart showing the displacements in the Z-axis direction that occur in the measurement sites D11 to D22 when the force in the positive direction of the X-axis + Fx and the force in the negative direction of the Z-axis −Fz act on the receiving portion 214. be. In FIG. 11, “+” indicates that the displacement is positive in the Z-axis direction, and “++” indicates that the displacement is large in the Z-axis direction. Further, "-" indicates that the displacement is in the negative direction of the Z-axis, and "-" indicates that the displacement is large in the negative direction of the Z-axis. If the directions of the acting forces are reversed, the positive and negative directions of each are reversed.

< 2−3. 力覚センサの構成 >
次に、1−2、1−3において説明した基本構造200を有する力覚センサ200cの構成について説明する。図12は、図10の基本構造200を採用した力覚センサ200cの例を示す概略正面図であり、図13は図12の力覚センサ200cに採用されている検出回路240のブロック図である。
<2-3. Force sensor configuration >
Next, the configuration of the force sensor 200c having the basic structure 200 described in 1-2, 1-3 will be described. FIG. 12 is a schematic front view showing an example of the force sensor 200c adopting the basic structure 200 of FIG. 10, and FIG. 13 is a block diagram of the detection circuit 240 adopted in the force sensor 200c of FIG. ..

図12に示すように、力覚センサ200cは、上述した基本構造200と、基本構造200の各梁221a、221bに規定された4つの計測部位D11〜D22に生じるそれぞれの変位に基づいて、作用した力を検出する検出回路240と、を有している。本実施の形態の検出回路240は、図12に示すように、変位センサとして、第1−1計測部位D11に配置された第1−1容量素子C11、第1−2計測部位D12に配置された第1−2容量素子C12、第2−1計測部位D21に配置された第2−1容量素子C21、及び、第2−2計測部位D22に配置された第2−2容量素子C22を有している。 As shown in FIG. 12, the force sensor 200c operates based on the above-mentioned basic structure 200 and the displacements that occur in the four measurement sites D11 to D22 defined in the beams 221a and 221b of the basic structure 200. It has a detection circuit 240 for detecting the generated force. As shown in FIG. 12, the detection circuit 240 of the present embodiment is arranged as a displacement sensor in the 1-1 capacitance element C11 and the 1-2 measurement site D12 arranged in the 1-1 measurement site D11. It also has a 1-2 capacitive element C12, a 2-1 capacitive element C21 arranged at the 2-1 measurement site D21, and a 2-2 capacitive element C22 arranged at the 2-2 measurement site D22. doing.

更に、検出回路240は、後述されるように、容量素子C11〜C22に接続され、当該容量素子C11〜C22の静電容量値の変動量に基づいて、作用した力を計測し出力する機能を有している。図示されるように、第1−1容量素子C11及び第1−2容量素子C12は、第1梁221aと第1接続体222aとの接続部位に関して対称的に配置されており、第2−1容量素子C21及び第2−2容量素子C22は、第2梁221bと第2接続体222bとの接続部位に関して対称的に配置されている。 Further, as will be described later, the detection circuit 240 has a function of being connected to the capacitance elements C11 to C22 and measuring and outputting the acting force based on the fluctuation amount of the capacitance value of the capacitance elements C11 to C22. Have. As shown, the 1-1 capacitive element C11 and the 1-2 capacitive element C12 are arranged symmetrically with respect to the connection portion between the first beam 221a and the first connecting body 222a, and are arranged symmetrically with respect to the connection portion of the first beam 221a and the first connecting body 222a. The capacitive element C21 and the 2-2 capacitive element C22 are arranged symmetrically with respect to the connection portion between the second beam 221b and the second connecting body 222b.

図12に示すように、第1−1容量素子C11は、第1梁221aの第1−1計測部位D11に絶縁体を介して配置された第1−1変位電極Em11と、支持体250上に絶縁体を介して第1−1変位電極Em11に対向して配置された第1−1固定電極Ef11と、を有している。第1−2容量素子C12は、第1梁221aの第1−2計測部位D12に絶縁体を介して配置された第1−2変位電極Em12と、支持体250上に絶縁体を介して第1−2変位電極Em12に対向して配置された第1−2固定電極Ef12と、を有している。なお、第1−1変位電極Em11及び第1−2変位電極Em12と、1−1固定電極Ef11及び1−2固定電極Ef12と、の一方が共通の電極で構成されていても良い。 As shown in FIG. 12, the 1-1 capacitance element C11 is on the support 250 and the 1-1 displacement electrode Em11 arranged at the 1-1 measurement portion D11 of the first beam 221a via an insulator. It has a 1-1 fixed electrode Ef11 arranged so as to face the 1-1 displacement electrode Em11 via an insulator. The first and second capacitive elements C12 are the first and second displacement electrodes Em12 arranged via an insulator on the first and second measurement sites D12 of the first beam 221a and the first on the support 250 via the insulator. It has a 1-2 fixed electrode Ef12, which is arranged so as to face the 1-2 displacement electrode Em12. One of the 1-1 displacement electrode Em11 and the 1-2 displacement electrode Em12 and the 1-1 fixed electrode Ef11 and the 1-2 fixed electrode Ef12 may be configured by a common electrode.

更に、図12に示すように、第2−1容量素子C21は、第2梁221bの第2−1計測部位D21に絶縁体を介して配置された第2−1変位電極Em21と、支持体250上に絶縁体を介して第2−1変位電極Em21に対向して配置された第2−1固定電極Ef21と、を有している。第2−2容量素子C22は、第2梁221bの第2−2計測部位D22に絶縁体を介して配置された第2−2変位電極Em22と、支持体250上に絶縁体を介して第2−2変位電極Em22に対向して配置された第2−2固定電極Ef22と、を有している。なお、第2−1変位電極Em21及び第2−2変位電極E22と、2−1固定電極Ef21及び2−2固定電極Ef22と、の一方が共通の電極で構成されていても良い。 Further, as shown in FIG. 12, the 2-1 capacitance element C21 includes a second displacement electrode Em21 arranged via an insulator at the 2-1 measurement portion D21 of the second beam 221b and a support. It has a 2-1 fixed electrode Ef21 arranged on the 250 so as to face the 2-1 displacement electrode Em21 via an insulator. The 2nd-2nd capacitive element C22 has a 2nd-2nd displacement electrode Em22 arranged via an insulator at the 2nd-2nd measurement portion D22 of the 2nd beam 221b, and a second displacement electrode Em22 on the support 250 via the insulator. It has a 2-2 fixed electrode Ef22, which is arranged so as to face the 2-2 displacement electrode Em22. One of the 2-1 displacement electrode Em21 and the 2-2 displacement electrode E22 and the 2-1 fixed electrode Ef21 and the 2-2 fixed electrode Ef22 may be configured by a common electrode.

また、図13に示すように、検出回路240は、第1の実施の形態の検出回路40と同様に、C/V変換器42及びマイコン44を有している。但し、本実施の形態のマイコン44は、力の検出が正常に行われているときの第1−1容量素子C11及び第1−2容量素子C12の静電容量値の差である第1電気信号T1(=C11−C12)と、第2−1容量素子C21及び第2−2容量素子C22の静電容量値の差である第2電気信号T2(=C21−C22)と、の比率を基準比率Rsとして記憶する記憶回路を有している点で、第1の実施の形態と異なる。 Further, as shown in FIG. 13, the detection circuit 240 has a C / V converter 42 and a microcomputer 44, similarly to the detection circuit 40 of the first embodiment. However, in the microcomputer 44 of the present embodiment, the first electric circuit which is the difference between the capacitance values of the 1-1 capacitance element C11 and the 1-2 capacitance element C12 when the force is normally detected. The ratio of the signal T1 (= C11-C12) to the second electric signal T2 (= C21-C22), which is the difference between the capacitance values of the 2-1 capacitance element C21 and the 2-2 capacitance element C22. It differs from the first embodiment in that it has a storage circuit that stores the reference ratio Rs.

容量素子C11〜C22は、図12には明確には図示されていないが、所定の回路によってC/V変換器42に接続されており、このC/V変換器42に接続されたマイコン44によって、各容量素子C11〜C22の静電容量値の変動量に基づき作用した力が計測されるようになっている。 Although the capacitive elements C11 to C22 are not clearly shown in FIG. 12, they are connected to the C / V converter 42 by a predetermined circuit, and are connected to the C / V converter 42 by the microcomputer 44 connected to the C / V converter 42. , The acting force is measured based on the fluctuation amount of the capacitance value of each capacitance element C11 to C22.

< 2−4. 力覚センサの作用 >
次に、図14は、図12の力覚センサ200cに力+Fx及び−Fzが作用した際の、各容量素子C11〜C22の静電容量値の変動を示す図表である。図14に示された各容量素子C11〜C22の静電容量値の変動は、図11の図表から明らかである。なお、図14において、「+」は、静電容量値が増大することを示しており、「++」は、静電容量値が大きく増大することを示している。また、「−」は、静電容量値が減少することを示しており、「−−」は、静電容量値が大きく減少することを示している。
<2-4. Action of force sensor >
Next, FIG. 14 is a chart showing changes in the capacitance values of the capacitance elements C11 to C22 when forces + Fx and −Fz act on the force sensor 200c of FIG. 12. The fluctuation of the capacitance value of each of the capacitance elements C11 to C22 shown in FIG. 14 is clear from the chart of FIG. In FIG. 14, “+” indicates that the capacitance value increases, and “++” indicates that the capacitance value increases significantly. Further, "-" indicates that the capacitance value decreases, and "-" indicates that the capacitance value decreases significantly.

力覚センサ200の受力部214に力+Fx、−Fzが作用した際の各容量素子C11〜C22の静電容量値の変動の符号(増大か減少か)について見ると、第1の実施の形態による力覚センサ100cの受力部14に力+Fx、−Fzが作用した際の各容量素子C11〜C22の符号と同じである(図9参照)。もちろん、逆向きの力−Fx、+Fzが作用した場合についても、同様のことが成り立つ。このため、力覚センサ200cに作用した力+Fx、−Fzは、上述した[式2]及び[式3]によって、それぞれ算出され得る。 Looking at the sign (increase or decrease) of the change in the capacitance value of each of the capacitance elements C11 to C22 when the force + Fx and −Fz act on the force receiving portion 214 of the force sensor 200, the first embodiment is performed. It is the same as the code of each capacitive element C11 to C22 when the force + Fx and −Fz act on the force receiving portion 14 of the force sensor 100c according to the form (see FIG. 9). Of course, the same applies when the opposite forces -Fx and + Fz act. Therefore, the forces + Fx and −Fz acting on the force sensor 200c can be calculated by the above-mentioned [Equation 2] and [Equation 3], respectively.

なお、力Fx、Fzを計測するに当たっては、S/Nの観点から、静電容量値が相対的に大きく変動する容量素子C11、C21に基づく第1電気信号T1([式4参照])、または、全ての容量素子C11〜C22に基づく合算電気信号T3([式4参照])、を用いることが好ましい。 In measuring the forces Fx and Fz, the first electric signal T1 (see [Equation 4]) based on the capacitance elements C11 and C21 whose capacitance values fluctuate relatively greatly from the viewpoint of S / N. Alternatively, it is preferable to use the total electrical signal T3 (see [Equation 4]) based on all the capacitive elements C11 to C22.

< 2−5. 故障診断 >
本実施の形態の検出回路240は、力覚センサ200cが正常に機能しているか否かを判定する機能を有している。ここでは、この故障診断の機能について説明を行う。
<2-5. Failure diagnosis >
The detection circuit 240 of the present embodiment has a function of determining whether or not the force sensor 200c is functioning normally. Here, the function of this failure diagnosis will be described.

力覚センサ200cの受力部214に力Fx、Fzが繰り返し作用すると、変形体210に金属疲労が生じる。金属疲労は、力Fx、Fzによる弾性変形が相対的に大きい第1−1変形部211a及び第1−2変形部212aで顕著に発現する。この金属疲労が蓄積されると、第1−1変形部211a及び第1−2変形部211bの強度が低下し、最終的に変形体210が破断することになる。金属材料に金属疲労が蓄積すると、当該金属材料が軟化する。このため、第1−1変形部211a及び第1−2変形部212aのバネ定数が小さくなる。すなわち、本実施の形態の変形部210では、第1−1変形部211a及び第1−2変形部212aに金属疲労が蓄積すると、当該変形部211a、212a力Fx、Fzによって大きく変形されるようになる。このため、第1−1変形部211a及び第1−2変形部212aの影響を受ける第1−1容量素子C11及び第1−2容量素子C12によって与えられる第1電気信号T1の感度が上昇する。 When the forces Fx and Fz repeatedly act on the force receiving portion 214 of the force sensor 200c, metal fatigue occurs in the deformed body 210. Metal fatigue is remarkably exhibited in the 1-1 deformed portion 211a and the 1-2 deformed portion 212a in which the elastic deformation due to the forces Fx and Fz is relatively large. When this metal fatigue accumulates, the strength of the 1-1 deformed portion 211a and the 1-2 deformed portion 211b decreases, and finally the deformed body 210 breaks. When metal fatigue accumulates in a metal material, the metal material softens. Therefore, the spring constants of the 1-1 deformed portion 211a and the 1-2 deformed portion 212a become smaller. That is, in the deformed portion 210 of the present embodiment, when metal fatigue accumulates in the 1-1 deformed portion 211a and the 1-2 deformed portion 212a, the deformed portions 211a, 212a forces Fx and Fz are significantly deformed. become. Therefore, the sensitivity of the first electric signal T1 given by the 1-1 capacitive element C11 and the 1-2 capacitive element C12 affected by the 1-1 deformed portion 211a and the 1-2 deformed portion 212a is increased. ..

もちろん、金属疲労は、第2−1変形部211b及び第2−2変形部212bにも発現する。しかしながら、第1−1変形部211a及び第1−2変形部212aのバネ定数と、第2−1変形部211b及び第2−2変形部212bのバネ定数と、の相違から、第2−1変形部211b及び第2−2変形部212bに生じる金属疲労は、第1−1変形部211a及び第1−2変形部212aより小さいと考えられる。 Of course, metal fatigue also appears in the 2-1 deformed portion 211b and the 2-2 deformed portion 212b. However, due to the difference between the spring constants of the 1-1 deformed portion 211a and the 1-2 deformed portion 212a and the spring constants of the 2-1 deformed portion 211b and the 2-2 deformed portion 212b, the 2-1st deformed portion 2-1. It is considered that the metal fatigue generated in the deformed portion 211b and the 2-2 deformed portion 212b is smaller than that of the 1-1 deformed portion 211a and the 1-2 deformed portion 212a.

ここで、図15は、図12の力覚センサ200cの変形体210に金属疲労が生じていないときの、受力部214に作用するX軸正方向の力+Fxと電気信号T1、T2との関係を示すグラフである。図15において、符号T1aは、第1電気信号T1のグラフを示し、符号T2aは、第2電気信号T2のグラフを示している。したがって、各図において、電気信号T1a、T2aを示す直線の傾きは、力覚センサ200cの検出感度を示すことになる。各グラフの傾き(感度)の相違は、第1−1変形部211a及び第1−2変形部212aのバネ定数と、第2−1変形部211b及び第2−2変形部212bのバネ定数と、の相違に起因している。 Here, FIG. 15 shows the force + Fx in the positive direction of the X-axis acting on the receiving portion 214 and the electric signals T1 and T2 when the deformed body 210 of the force sensor 200c of FIG. 12 is not subjected to metal fatigue. It is a graph which shows the relationship. In FIG. 15, reference numeral T1a indicates a graph of the first electric signal T1, and reference numeral T2a indicates a graph of the second electric signal T2. Therefore, in each figure, the slope of the straight line indicating the electric signals T1a and T2a indicates the detection sensitivity of the force sensor 200c. The difference in the inclination (sensitivity) of each graph is the spring constants of the 1-1 deformed portion 211a and the 1-2 deformed portion 212a and the spring constants of the 2-1 deformed portion 211b and the 2-2 deformed portion 212b. Due to the difference in.

図15に示すように、力覚センサ200cの変形体210に金属疲労が生じていないとき、第1電気信号T1及び第2電気信号T2は、力+Fxに比例する。第1電気信号T1を示すグラフの傾きm1aは2であり、第2電気信号T2を示すグラフの傾きm2aは0.5である。すなわち、傾きの比(m1a/m2a)は、4である。この値が、基準比率Rs(=T1a/T2a)である。 As shown in FIG. 15, when metal fatigue does not occur in the deformed body 210 of the force sensor 200c, the first electric signal T1 and the second electric signal T2 are proportional to the force + Fx. The slope m1a of the graph showing the first electric signal T1 is 2, and the slope m2a of the graph showing the second electric signal T2 is 0.5. That is, the inclination ratio (m1a / m2a) is 4. This value is the reference ratio Rs (= T1a / T2a).

次に、図16は、図12の力覚センサ200cの変形体210に金属疲労が生じているときの、受力部214に作用するX軸正方向の力+Fxと電気信号T1、T2との関係を示すグラフである。図16において、符号T1bは、第1電気信号T1のグラフを示し、符号T2bは、第2電気信号T2のグラフを示している。 Next, FIG. 16 shows the force + Fx in the positive direction of the X-axis acting on the receiving portion 214 and the electric signals T1 and T2 when metal fatigue occurs in the deformed body 210 of the force sensor 200c of FIG. It is a graph which shows the relationship. In FIG. 16, reference numeral T1b indicates a graph of the first electric signal T1, and reference numeral T2b indicates a graph of the second electric signal T2.

図16に示すように、力覚センサ200cの変形体210に金属疲労が生じると、第1電気信号T1を示すグラフの傾きm1bは3に増大し(感度が50%増大し)、第2電気信号T2を示すグラフの傾きm2bは0.6に増大した(感度が20%増大した)。したがって、確かに、第2−1変形部211b及び第2−2変形部212bに生じる金属疲労は、第1−1変形部211a及び第1−2変形部212aよりも小さい。図16において、各グラフの傾きの比(m1b/m2b)は、5である。 As shown in FIG. 16, when metal fatigue occurs in the deformed body 210 of the force sensor 200c, the slope m1b of the graph showing the first electric signal T1 increases to 3 (sensitivity increases by 50%), and the second electricity The slope m2b of the graph showing the signal T2 increased to 0.6 (sensitivity increased by 20%). Therefore, it is true that the metal fatigue generated in the 2-1 deformed portion 211b and the 2-2 deformed portion 212b is smaller than that in the 1-1 deformed portion 211a and the 1-2 deformed portion 212a. In FIG. 16, the slope ratio (m1b / m2b) of each graph is 5.

ここで着目すべきは、第1−1変形部211a及び第1−2変形部212aと第2−1変形部211b及び第2−2変形部212bとで、金属疲労の発現の程度が異なっているということである。すなわち、金属疲労が発現する前には、第1電気信号T1aと第2電気信号T2aとの比(T1a/T2a=基準比率Rs)は、4であるのに対し、金属疲労が発現した後では、第1電気信号T1bと第2電気信号T2bとの比率(T1b/T2b)は、5に上昇しているということである。本実施の形態では、このことを利用して力覚センサ200cの故障診断を行う。 What should be noted here is that the degree of occurrence of metal fatigue differs between the 1-1 deformed portion 211a and the 1-2 deformed portion 212a and the 2-1 deformed portion 211b and the 2-2 deformed portion 212b. It means that there is. That is, before the onset of metal fatigue, the ratio of the first electric signal T1a to the second electric signal T2a (T1a / T2a = reference ratio Rs) is 4, whereas after the onset of metal fatigue, , The ratio (T1b / T2b) of the first electric signal T1b and the second electric signal T2b has increased to 5. In the present embodiment, this is used to diagnose the failure of the force sensor 200c.

換言すれば、第1−1変形部211a及び第1−2変形部212aと第2−1変形部211b及び第2−2変形部212bとで金属疲労の蓄積及び発現の特性が異なるため、繰り返しの負荷に伴って第1電気信号T1と第2電気信号T2との比率が次第に変化する。そして、力覚センサ200cに繰り返しの負荷が更に作用すると、変形体210は最終的に第1−1変形部211a及び第1−2変形部212aのいずれかにおいて破断し、適正な力の検出を行うことができなくなる。 In other words, since the characteristics of accumulation and manifestation of metal fatigue are different between the 1-1 deformed portion 211a and the 1-2 deformed portion 212a and the 2-1 deformed portion 211b and the 2-2 deformed portion 212b, it is repeated. The ratio of the first electric signal T1 and the second electric signal T2 gradually changes with the load of. Then, when a repeated load is further applied to the force sensor 200c, the deformed body 210 finally breaks at either the 1-1 deformed portion 211a or the 1-2 deformed portion 212a, and an appropriate force is detected. You will not be able to do it.

以上のことから、力Fx、Fzを、相対的にバネ定数が大きい変形部211b、212bに関連付けられた第2電気信号T2を用いて計測しつつ、その計測時における第1電気信号T1と第2電気信号T2との比率と、金属疲労が発現していない初期状態における第1電気信号T1aと第2電気信号T2aとの比率と、の差が所定の範囲内にあるか否かを評価することによって、力覚センサ200cが正常に機能しているか否かを判定することができる。もちろん、力Fx、Fzを、第1電気信号T1に基づいて計測しても良い。この場合、第1電気信号T1を提供する容量素子C11、C12はバネ定数が相対的に小さい変形部211a、212aに関連付けられているため、作用する力Fx、Fzに対する感度が高く、S/Nに優れた力の計測が可能となる。あるいは、第1電気信号T1と第2電気信号T2との和で、作用する力Fx、Fzを計測しても良い。 From the above, while measuring the forces Fx and Fz using the second electric signal T2 associated with the deformed portions 211b and 212b having relatively large spring constants, the first electric signal T1 and the first electric signal T1 at the time of the measurement are measured. 2 Evaluate whether or not the difference between the ratio of the electric signal T2 and the ratio of the first electric signal T1a and the second electric signal T2a in the initial state in which metal fatigue does not occur is within a predetermined range. Thereby, it can be determined whether or not the force sensor 200c is functioning normally. Of course, the forces Fx and Fz may be measured based on the first electric signal T1. In this case, since the capacitance elements C11 and C12 that provide the first electric signal T1 are associated with the deformed portions 211a and 212a having relatively small spring constants, they are highly sensitive to the acting forces Fx and Fz, and the S / N It enables excellent force measurement. Alternatively, the acting forces Fx and Fz may be measured by the sum of the first electric signal T1 and the second electric signal T2.

故障診断を行う手順は、次の通りである。すなわち、マイコン44の比較回路が、記憶回路に記憶された初期状態の第1電気信号T1aと第2電気信号T2a比率(T1a/T2a)と、現在の第1電気信号T1と第2電気信号T2との比率と、を比較する。この比較結果は、マイコン44の診断回路に提供される。この診断回路は、提供された比較結果が所定の範囲内にあるか否かを判定する。診断の結果、初期状態の比率(T1a/T2a)と現在の比率(T1/T2)との差が所定の範囲内にあれば、マイコン47は、力覚センサ200cが正常に機能していると判定し、計測された力Fx、Fzの値を出力する。一方、当該差が所定の範囲内に無ければ、マイコン47は、力覚センサ200cが正常に機能していない(故障している)と判定し、故障診断信号を出力する。 The procedure for performing a failure diagnosis is as follows. That is, the comparison circuit of the microcomputer 44 has the first electric signal T1a and the second electric signal T2a ratio (T1a / T2a) in the initial state stored in the storage circuit, and the current first electric signal T1 and second electric signal T2. Compare the ratio with. The comparison result is provided to the diagnostic circuit of the microcomputer 44. The diagnostic circuit determines if the provided comparison results are within a predetermined range. As a result of the diagnosis, if the difference between the ratio in the initial state (T1a / T2a) and the current ratio (T1 / T2) is within a predetermined range, the microcomputer 47 indicates that the force sensor 200c is functioning normally. Judgment is made and the measured force Fx and Fz values are output. On the other hand, if the difference is not within a predetermined range, the microcomputer 47 determines that the force sensor 200c is not functioning normally (failed), and outputs a failure diagnosis signal.

以上のような本実施の形態によれば、第1−1容量素子C11及び第2−1容量素子C21の静電容量値の変動量に基づく第1電気信号T1と、第1−2容量素子C12及び第2−2容量素子C22の静電容量値の変動量に基づく第2電気信号T2と、の比率の変化に基づいて、力覚センサ200cの故障診断が行われる。この故障診断では、容量素子C11〜C22の電極に生じた異常のみならず、変形体210に生じた金属疲労に起因する力覚センサ200cの故障をも診断することができる。さらに、力覚センサ200cにおいては、傾動部213a、213bの傾動によって各計測部位D11〜D22が変位するため、傾動部213a、213bに生じる傾動を効果的に増幅させることができる。すなわち、本実施の形態によれば、低価格且つ高感度でありながら、単一の力覚センサ200cによってそれ自身の故障診断が可能である、という力覚センサ200cを提供することができる。 According to the present embodiment as described above, the first electric signal T1 based on the fluctuation amount of the capacitance value of the 1-1 capacitance element C11 and the 2-1 capacitance element C21 and the 1-2 capacitance element Failure diagnosis of the force sensor 200c is performed based on the change in the ratio of the second electric signal T2 based on the fluctuation amount of the capacitance value of the C12 and the 2-2 capacitance element C22. In this failure diagnosis, not only the abnormality generated in the electrodes of the capacitive elements C11 to C22 but also the failure of the force sensor 200c caused by the metal fatigue generated in the deformed body 210 can be diagnosed. Further, in the force sensor 200c, since the measurement portions D11 to D22 are displaced by the tilting of the tilting portions 213a and 213b, the tilting generated in the tilting portions 213a and 213b can be effectively amplified. That is, according to the present embodiment, it is possible to provide a force sensor 200c that can diagnose its own failure by a single force sensor 200c while being inexpensive and having high sensitivity.

また、本実施の形態においても、検出回路240は、静電容量値の差分によって作用した力Fx、Fzを計測するため、使用環境の温度変化や同相ノイズの影響を受けにくい力覚センサ200cが提供され得る。 Further, also in the present embodiment, since the detection circuit 240 measures the forces Fx and Fz acting by the difference in the capacitance value, the force sensor 200c which is not easily affected by the temperature change of the usage environment and the in-phase noise is provided. Can be provided.

また、変位体20の第1−1計測部位D11及び第1−2計測部位D12は第1梁221aに第1接続体222aと第1梁221aとの接続部位に関して対称的に配置され、第2−1計測部位D21及び第2−2計測部位D22は第2梁221bに第2接続体222bと第2梁221bとの接続部位に関して対称的に配置されている。このような対称的な配置により、作用した力が簡易な演算によって検出され得る。 Further, the 1-1 measurement portion D11 and the 1-2 measurement portion D12 of the displacement body 20 are symmetrically arranged on the first beam 221a with respect to the connection portion between the first connection body 222a and the first beam 221a, and the second beam. The -1 measurement portion D21 and the 2-2 measurement portion D22 are arranged symmetrically on the second beam 221b with respect to the connection portion between the second connecting body 222b and the second beam 221b. With such a symmetrical arrangement, the acting force can be detected by a simple calculation.

< 2−6. 変形例 >
なお、以上の力覚センサ200cは、変位体220が両持ち梁の構造を有していたが、これに代えて片持ち梁の構造を有していても良い。そのような例が図59に示されている。図59は、変位体220が片持ち梁の構造を有する、図12の変形例による力覚センサ201cの概略正面図である。図59に示す例では、第1変位体220paが、上述した力覚センサ200cの第1梁221aのうち、第1−2計測部位D12が規定されている側の部分が欠落した片持ち梁の構造(符号221pa)を有している。更に、第2変位体220pbが、力覚センサ200cの第2梁221bのうち、第2−2計測部位D22が規定されている側の部分が欠落した片持ち梁の構造(符号221pb)を有している。この他の構成は、図12に示す力覚センサ200cと同じであるため、図59において、力覚センサ200cと共通する構成に図12と同じ符号を付し、その詳細な説明を省略する。
<2-6. Modification example >
In the above force sensor 200c, the displacement body 220 has a double-sided beam structure, but instead of this, a cantilever structure may be provided. An example of such is shown in FIG. FIG. 59 is a schematic front view of the force sensor 201c according to the modified example of FIG. 12, in which the displacement body 220 has a cantilever structure. In the example shown in FIG. 59, the first displacement body 220pa is a cantilever beam in which the portion of the first beam 221a of the above-mentioned force sensor 200c on which the 1-2 measurement portion D12 is defined is missing. It has a structure (reference numeral 221pa). Further, the second displacement body 220pb has a cantilever structure (reference numeral 221pb) in which the portion of the second beam 221b of the force sensor 200c on the side where the 2-2 measurement portion D22 is defined is missing. doing. Since the other configurations are the same as those of the force sensor 200c shown in FIG. 12, in FIG. 59, the configurations common to the force sensor 200c are designated by the same reference numerals as those in FIG. 12, and detailed description thereof will be omitted.

このような力覚センサ201cでは、上述した[式2]〜[式4]においてC21=C22=0とすれば、2−4.及び2−5.の説明に基づいて、力覚センサ201cに作用した力を検出でき、更には、力覚センサ201cの故障診断を行うことが可能である。但し、図59に示す力覚センサ201cは、作用した力Fx、Fzを容量素子の静電容量値の差によって検出することができない。このため、力覚センサ201cは、使用環境における温度変化や同相ノイズの影響を受けやすい点に注意が必要である。 In such a force sensor 201c, if C21 = C22 = 0 in the above-mentioned [Equation 2] to [Equation 4], 2-4. And 2-5. Based on the above description, the force acting on the force sensor 201c can be detected, and further, the failure diagnosis of the force sensor 201c can be performed. However, the force sensor 201c shown in FIG. 59 cannot detect the acting forces Fx and Fz due to the difference in the capacitance value of the capacitance element. Therefore, it should be noted that the force sensor 201c is easily affected by temperature changes and in-phase noise in the usage environment.

<<< §3. 本発明の第3の実施の形態による力覚センサ >>>
次に、本発明の第3の実施の形態による力覚センサ300cについて説明する。
<<< §3. Force sensor according to the third embodiment of the present invention >>>
Next, the force sensor 300c according to the third embodiment of the present invention will be described.

< 3−1. 基本構造の構成 >
図17は、本発明の第3の実施の形態による力覚センサ300cの基本構造300を示す概略上面図である。図18は、図17のY軸正側から見た基本構造300を示す概略正面図であり、図19は、図17のX軸正側から見た基本構造300を示す概略側面図である。ここでは、図17乃至図19に示すようにXYZ三次元座標系を定義して以下の説明を行うこととする。なお、図17では、説明の便宜上、受力体360の図示が省略されている。
<3-1. Structure of basic structure >
FIG. 17 is a schematic top view showing the basic structure 300 of the force sensor 300c according to the third embodiment of the present invention. FIG. 18 is a schematic front view showing the basic structure 300 seen from the Y-axis positive side of FIG. 17, and FIG. 19 is a schematic side view showing the basic structure 300 seen from the X-axis positive side of FIG. Here, as shown in FIGS. 17 to 19, the XYZ three-dimensional coordinate system is defined and the following description is given. In FIG. 17, for convenience of explanation, the drawing of the receiving body 360 is omitted.

図17乃至図19に示すように、基本構造300は、閉ループ状の変形体であって、2つの受力部318、319と、閉ループ状の経路に沿って当該2つの受力部318、319と交互に配置された2つの固定部316、317と、閉ループ状の経路に沿って隣接する受力部318、319及び固定部316、317によって挟まれた4つの間隙に1つずつ配置され、受力部318、319に作用した力ないしモーメントにより弾性変形を生じる4つの変形要素310A〜310Dと、を有する変形体と、を備えている。基本構造300は、更に、各変形要素310A〜310Dに接続され、当該変形要素310A〜310Dに生じる弾性変形により変位を生じる4つの変位体320A〜320Dを備えている。 As shown in FIGS. 17 to 19, the basic structure 300 is a closed-loop deformed body, and has two receiving portions 318 and 319 and the two receiving portions 318 and 319 along the closed-loop path. It is arranged one by one in four gaps sandwiched between two fixing portions 316 and 317 arranged alternately with the above, and adjacent receiving portions 318, 319 and fixing portions 316 and 317 along a closed loop path. It includes four deformable elements 310A to 310D, which are elastically deformed by a force or moment acting on the receiving portions 318 and 319, and a deformed body having four deformable elements 310A to 310D. The basic structure 300 further includes four displacement bodies 320A to 320D that are connected to the deformation elements 310A to 310D and cause displacement due to elastic deformation that occurs in the deformation elements 310A to 310D.

本実施の形態では、図17に示すように、一方の受力部318は正のX軸上に、他方の受力部319は負のX軸上に、互いに原点Oに関して対称的に配置されている。また、一方の固定部316は正のY軸上に、他方の固定部317は負のY軸上に、互いに原点Oに関して対称的に配置されている。これら受力部318、319及び固定部316、317を含む閉ループ状の変形体は、本実施の形態では、原点Oを中心とする円形の環状変形体310として構成されている。 In this embodiment, as shown in FIG. 17, one receiving portion 318 is arranged on the positive X-axis and the other receiving portion 319 is arranged symmetrically with respect to the origin O on the negative X-axis. ing. Further, one fixed portion 316 is arranged symmetrically with respect to the origin O on the positive Y axis and the other fixed portion 317 is arranged on the negative Y axis. In the present embodiment, the closed loop-shaped deformed body including the receiving portions 318, 319 and the fixed portions 316 and 317 is configured as a circular annular deformed body 310 centered on the origin O.

図17乃至図19に示すように、Z軸方向から見てXY平面の第2象限に配置された第1変形要素310Aは、X軸負側に配置された受力部319とY軸正側に配置された固定部316との間に弧状に配置されており、Z軸方向(図17における奥行き方向)を長手方向とする第1傾動部313Aと、受力部319と第1傾動部313Aとを接続する第1−1変形部311Aと、固定部316と第1傾動部313Aとを接続する第1−2変形部312Aと、を有している。図18に示すように、第1−1変形部311Aは、XY平面と平行に延在し、第1傾動部313AのZ軸負側の端部(下端)にて、当該第1傾動部313Aに接続されている。第1−2変形部312Aは、XY平面と平行に延在し、第1傾動部313AのZ軸正側の端部(上端)にて、当該第1傾動部313Aに接続されている。 As shown in FIGS. 17 to 19, the first deformation element 310A arranged in the second quadrant of the XY plane when viewed from the Z-axis direction has a receiving portion 319 arranged on the negative side of the X-axis and the positive side of the Y-axis. The first tilting portion 313A, which is arranged in an arc between the fixed portions 316 arranged in the above direction and has the Z-axis direction (depth direction in FIG. 17) as the longitudinal direction, and the receiving portion 319 and the first tilting portion 313A. It has a 1-1 deformed portion 311A for connecting the above, and a 1-2 deformed portion 312A for connecting the fixed portion 316 and the first tilting portion 313A. As shown in FIG. 18, the 1-1 deformed portion 311A extends parallel to the XY plane, and at the end (lower end) on the negative side of the Z axis of the first tilting portion 313A, the first tilting portion 313A. It is connected to the. The 1-2 deformed portion 312A extends parallel to the XY plane and is connected to the first tilting portion 313A at the end (upper end) of the first tilting portion 313A on the positive side of the Z axis.

Z軸方向から見てXY平面の第1象限に配置された第2変形要素310Bは、X軸正側に配置された受力部318とY軸正側に配置された固定部316との間に弧状に配置され、Z軸方向(図17における奥行き方向)を長手方向とする第2傾動部313Bと、受力部318と第2傾動部313Bとを接続する第2−1変形部311Bと、固定部316と第2傾動部313Bとを接続する第2−2変形部312Bと、を有している。図18に示すように、第2−1変形部311Bは、XY平面と平行に延在し、第2傾動部313BのZ軸負側の端部(下端)にて、当該第2傾動部313Bに接続されている。第2−2変形部312Bは、XY平面と平行に延在し、第2傾動部313BのZ軸正側の端部(上端)にて、当該第2傾動部313Bに接続されている。 The second deformation element 310B arranged in the first quadrant of the XY plane when viewed from the Z-axis direction is between the receiving portion 318 arranged on the positive side of the X-axis and the fixed portion 316 arranged on the positive side of the Y-axis. The second tilting portion 313B, which is arranged in an arc shape and has the Z-axis direction (depth direction in FIG. 17) as the longitudinal direction, and the 2-1 deforming portion 311B that connects the receiving portion 318 and the second tilting portion 313B. It has a 2-2 deformed portion 312B that connects the fixed portion 316 and the second tilting portion 313B. As shown in FIG. 18, the 2-1 deformed portion 311B extends parallel to the XY plane, and at the end (lower end) on the negative side of the Z axis of the second tilting portion 313B, the second tilting portion 313B It is connected to the. The 2-2 deformed portion 312B extends parallel to the XY plane and is connected to the second tilted portion 313B at the end (upper end) of the second tilted portion 313B on the positive side of the Z axis.

更に、詳細には図示されていないが、XY平面の第3象限及び第4象限に配置された第4変形要素310D及び第3変形要素310Cは、環状変形体310のY軸正側(図17の環状変形体310の上半分)の部分を原点まわりに180°回転させたときの、上述した第2変形要素310B及び第1変形要素310Aの構成に、それぞれ対応している。このため、ここでは、その詳細な説明を省略する。図17乃至図19において、第3変形要素310Cの構成要素には符号の末尾に「C」が付され、第4変形要素310Dの構成要素には符号の末尾に「D」が付されている。更に、基本構造300の各固定部316、317は、その下端部が、後述される第1〜第4梁321A〜321Dに所定の間隔を空けて対向配置された支持体350に接続されている。 Further, although not shown in detail, the fourth deformation element 310D and the third deformation element 310C arranged in the third quadrant and the fourth quadrant of the XY plane are on the Y-axis positive side of the annular deformation body 310 (FIG. 17). Corresponds to the above-described configurations of the second deformable element 310B and the first deformable element 310A when the portion of the annular deformed body 310) is rotated by 180 ° around the origin. Therefore, the detailed description thereof will be omitted here. In FIGS. 17 to 19, the components of the third deformation element 310C have a “C” at the end of the code, and the components of the fourth deformation element 310D have a “D” at the end of the code. .. Further, each of the fixing portions 316 and 317 of the basic structure 300 is connected to a support 350 whose lower end portions are opposed to the first to fourth beams 321A to 321D described later at predetermined intervals. ..

図17乃至図19に示すように、前述した4つの変位体320A〜320Dは、第1〜第4変形要素310A〜310Dの各傾動部313A〜313Dの下端(Z軸負側の端部)に1つずつ接続されている。各変位体320A〜320Dは、それぞれ、対応する傾動部313A〜313Dの傾動によって変位する変位部を有している。この変位部は、図17乃至図19に示すように、各傾動部313A〜313Dの下端に接続体322A〜322Dを介してそれぞれ取り付けられた第1〜第4梁321A〜321Dである。 As shown in FIGS. 17 to 19, the four displacement bodies 320A to 320D described above are located at the lower ends (ends on the negative side of the Z axis) of the tilting portions 313A to 313D of the first to fourth deformation elements 310A to 310D. They are connected one by one. Each of the displacement bodies 320A to 320D has a displacement portion that is displaced by the tilt of the corresponding tilting portions 313A to 313D. As shown in FIGS. 17 to 19, the displacement portions are the first to fourth beams 321A to 321D attached to the lower ends of the tilting portions 313A to 313D via the connecting bodies 322A to 322D, respectively.

これらの梁321A〜322Dは、対応する傾動部313A〜313Dの長手方向(Z軸方向)と直交する方向に延在しており、環状変形体310の径方向から見て、いずれも、左右対称の形状を有している。いずれの梁321A〜322Dも、固定部316、317及び受力部318、319から離間しており、当該梁321A〜322Dの傾動(回動)が妨げられないようになっている。そして、第1梁321Aには、当該第1梁321Aと第1接続体322Aとの接続部位に関して対称的に、第1計測部位D1及び第2計測部位D2が規定されている。同様に、第2梁321Bには、当該第2梁321Bと第2接続体322Bとの接続部位に関して対称的に、第3計測部位D3及び第4計測部位D4が規定されており、第3梁321Cには、当該第3梁321Cと第3接続体322Cとの接続部位に関して対称的に、第5計測部位D5及び第6計測部位D6が規定されており、第4梁321Dには、当該第4梁321Dと第4接続体322Dとの接続部位に関して対称的に、第7計測部位D7及び第8計測部位D8が規定されている。後述されるように、これら第1〜第8計測部位D1〜D8のそれぞれに容量素子が2つずつ配置され、受力部318、319に作用した力及びモーメントが検出されることになる。結局、基本構造300は、第1〜第4変形要素310A〜310Dとして、§1で説明した基本構造100を4つ、円環状に配置して構成されている。 These beams 321A to 322D extend in a direction orthogonal to the longitudinal direction (Z-axis direction) of the corresponding tilting portions 313A to 313D, and are symmetrical when viewed from the radial direction of the annular deformed body 310. Has the shape of. Each of the beams 321A to 322D is separated from the fixing portion 316, 317 and the receiving portion 318, 319 so that the tilting (rotation) of the beams 321A to 322D is not hindered. The first beam 321A defines the first measurement portion D1 and the second measurement portion D2 symmetrically with respect to the connection portion between the first beam 321A and the first connecting body 322A. Similarly, in the second beam 321B, the third measurement portion D3 and the fourth measurement portion D4 are defined symmetrically with respect to the connection portion between the second beam 321B and the second connecting body 322B, and the third beam In 321C, the fifth measurement part D5 and the sixth measurement part D6 are defined symmetrically with respect to the connection part between the third beam 321C and the third connecting body 322C, and the fourth beam 321D has the said third beam 321D. The seventh measurement portion D7 and the eighth measurement portion D8 are defined symmetrically with respect to the connection portion between the four beams 321D and the fourth connecting body 322D. As will be described later, two capacitive elements are arranged in each of the first to eighth measurement sites D1 to D8, and the force and the moment acting on the receiving units 318 and 319 are detected. After all, the basic structure 300 is configured by arranging four basic structures 100 described in §1 in an annular shape as the first to fourth deformable elements 310A to 310D.

更に、図18及び図19に示すように、環状変形体310のZ軸正側には、検出対象の力を受けるための受力体360が配置されている。受力体360は、Z軸方向から見て、環状変形体310と重なる円環の形状を有する受力体本体361と、受力体本体361のうち、環状変形体310の受力部318、319に面する部位に設けられた受力部接続体362、363と、を有している。これらの受力部接続体362、363が、対応する受力部318、319に接続され、受力体本体361に作用した力及びモーメントが、各受力部318、319に伝達されるようになっている。 Further, as shown in FIGS. 18 and 19, a receiving body 360 for receiving a force to be detected is arranged on the Z-axis positive side of the annular deformed body 310. The receiving body 360 includes a receiving body body 361 having an annular shape that overlaps with the annular deformed body 310 when viewed from the Z-axis direction, and a receiving portion 318 of the annular deformed body 310 among the receiving body main bodies 361. It has receiving force connecting bodies 362 and 363 provided at a portion facing 319. These receiving parts connecting bodies 362 and 363 are connected to the corresponding receiving parts 318 and 319 so that the force and moment acting on the receiving body main body 361 are transmitted to the respective receiving parts 318 and 319. It has become.

< 3−2. 基本構造の作用 >
次に、以上のような基本構造300の作用について説明する。
<3-2. Action of basic structure >
Next, the operation of the basic structure 300 as described above will be described.

(3−2−1.力+Fxが作用した場合)
図20は、受力部318、319にX軸正方向の力+Fxが作用したときに、図17の基本構造300の各変位体320A〜320Dに生じる変位を説明するための図である。図20において、受力部318、319に作用する力は、黒塗りの太い矢印で示されている。また、力が作用したときに、各変形要素310A〜310Dの傾動部313A〜313Dに生じる傾動は、弧状の細い矢印で示されている。この矢印は、原点Oから観測したときの、各傾動部313A〜313Dの傾動の向き(時計回りか、反時計回りか)を表している。更に、各傾動部313A〜313Dの傾動によって変位体320A〜320Dの梁321A〜321Dの各計測部位D1〜D8に生じるZ軸方向の変位は、ドットを丸で囲んだ記号と、×印を丸で囲んだ記号と、によって示されている。ドットを丸で囲んだ記号は、奥側から手前側への変位(Z軸正方向への変位)を示しており、×印を丸で囲んだ記号は、手前側から奥側への変位(Z軸負方向への変位)を示している。なお、このような図示の方法は、後述される各実施の形態においても共通である。なお、受力部318、319に作用する力は、その向きによっては、ドットを丸で囲んだ記号と、×印を丸で囲んだ記号と、によって示してある。これらの記号の意味は、前述した通りである。
(3-2-1. When force + Fx acts)
FIG. 20 is a diagram for explaining the displacements that occur in the displacement bodies 320A to 320D of the basic structure 300 of FIG. 17 when a force + Fx in the positive direction of the X axis acts on the force receiving portions 318 and 319. In FIG. 20, the force acting on the receiving portions 318 and 319 is indicated by a thick black arrow. Further, the tilt generated in the tilting portions 313A to 313D of the deforming elements 310A to 310D when a force is applied is indicated by a thin arc-shaped arrow. This arrow indicates the direction of tilt (clockwise or counterclockwise) of each tilting portion 313A to 313D when observed from the origin O. Further, the displacement in the Z-axis direction caused by the tilting of the tilting portions 313A to 313D at the measurement sites D1 to D8 of the beams 321A to 321D of the displacement bodies 320A to 320D is represented by a symbol circled with a dot and a circle with a cross. It is indicated by a symbol surrounded by. The symbols circled with dots indicate the displacement from the back side to the front side (displacement in the positive direction of the Z axis), and the symbols circled with a cross indicate the displacement from the front side to the back side (displacement from the front side to the back side). Displacement in the negative direction of the Z axis) is shown. It should be noted that such an illustrated method is also common to each embodiment described later. The force acting on the receiving portions 318 and 319 is indicated by a symbol in which the dots are circled and a symbol in which the x mark is circled, depending on the direction thereof. The meanings of these symbols are as described above.

受力体360を介して受力部318、319にX軸正方向の力+Fxが作用すると、図20に示すように、受力部318、319がX軸正方向へ変位する。このことにより、第1変形要素310Aは、図3に示すような圧縮力の作用を受ける。この場合、第1傾動部313Aが反時計回りに傾動するため、第1梁321Aも反時計回りに傾動する。この結果、第1計測部位D1はZ軸負方向に変位し、第2計測部位D2はZ軸正方向に変位する。 When a force + Fx in the positive direction of the X-axis acts on the receiving portions 318 and 319 via the receiving body 360, the receiving portions 318 and 319 are displaced in the positive direction of the X-axis as shown in FIG. As a result, the first deforming element 310A is subjected to the action of the compressive force as shown in FIG. In this case, since the first tilting portion 313A tilts counterclockwise, the first beam 321A also tilts counterclockwise. As a result, the first measurement site D1 is displaced in the negative direction of the Z axis, and the second measurement site D2 is displaced in the positive direction of the Z axis.

第2変形要素310Bは、受力部318のX軸正方向への変位によって、図4に示すような引張力の作用を受ける。この場合、第2傾動部313Bが反時計回りに傾動するため、第2梁321Bも反時計回りに傾動する。この結果、第3計測部位D3はZ軸負方向に変位し、第4計測部位D4はZ軸正方向に変位する。 The second deformation element 310B is subjected to the action of a tensile force as shown in FIG. 4 due to the displacement of the receiving portion 318 in the positive direction of the X axis. In this case, since the second tilting portion 313B tilts counterclockwise, the second beam 321B also tilts counterclockwise. As a result, the third measurement site D3 is displaced in the negative direction of the Z axis, and the fourth measurement site D4 is displaced in the positive direction of the Z axis.

第3変形要素310Cは、受力部318のX軸正方向への変位によって、図4に示すような引張力の作用を受ける。この場合、第3傾動部313Cが時計回りに傾動するため、第3梁321Cも時計回りに傾動する。この結果、第5計測部位D5はZ軸正方向に変位し、第6計測部位D6はZ軸負方向に変位する。 The third deformation element 310C is subjected to the action of a tensile force as shown in FIG. 4 due to the displacement of the receiving portion 318 in the positive direction of the X axis. In this case, since the third tilting portion 313C tilts clockwise, the third beam 321C also tilts clockwise. As a result, the fifth measurement site D5 is displaced in the positive direction of the Z axis, and the sixth measurement site D6 is displaced in the negative direction of the Z axis.

更に、第4変形要素310Dは、受力部319のX軸正方向への変位によって、図3に示すような圧縮力の作用を受ける。この場合、第4傾動部313Dが時計回りに傾動するため、第4梁321Dも時計回りに傾動する。この結果、第7計測部位D7はZ軸正方向に変位し、第8計測部位D8はZ軸負方向に変位する。 Further, the fourth deformation element 310D is subjected to the action of the compressive force as shown in FIG. 3 due to the displacement of the receiving portion 319 in the positive direction of the X axis. In this case, since the fourth tilting portion 313D tilts clockwise, the fourth beam 321D also tilts clockwise. As a result, the 7th measurement site D7 is displaced in the positive direction of the Z axis, and the 8th measurement site D8 is displaced in the negative direction of the Z axis.

(3−2−2.力+Fyが作用した場合)
次に、図21は、受力部318、319にY軸正方向の力+Fyが作用したときに、図17の基本構造300の各変位体320A〜320Dに生じる変位を説明するための図である。
(3-2-2. When force + Fy acts)
Next, FIG. 21 is a diagram for explaining the displacements that occur in the displacement bodies 320A to 320D of the basic structure 300 of FIG. 17 when a force + Fy in the positive direction of the Y axis acts on the force receiving portions 318 and 319. be.

受力体360を介して受力部318、319にY軸正方向の力+Fyが作用すると、図21に示すように、受力部318、319がY軸正方向へ変位する。このことにより、第1変形要素310Aは、図3に示すような圧縮力の作用を受ける。この場合、前述したように、第1傾動部313A及び第1梁321Aが反時計回りに傾動するため、第1計測部位D1はZ軸負方向に変位し、第2計測部位D2はZ軸正方向に変位する。 When a force + Fy in the positive direction of the Y axis acts on the receiving portions 318 and 319 via the receiving body 360, the receiving portions 318 and 319 are displaced in the positive direction of the Y axis as shown in FIG. As a result, the first deforming element 310A is subjected to the action of the compressive force as shown in FIG. In this case, as described above, since the first tilting portion 313A and the first beam 321A tilt counterclockwise, the first measuring portion D1 is displaced in the negative Z-axis direction, and the second measuring portion D2 is positive in the Z-axis. Displace in the direction.

第2変形要素310Bは、受力部318のY軸正方向への変位によって、図3に示すような圧縮力の作用を受ける。この場合、第2傾動部313B及び第2梁321Bが時計回りに傾動するため、第3計測部位D3はZ軸正方向に変位し、第4計測部位D4はZ軸負方向に変位する。 The second deformation element 310B is subjected to the action of a compressive force as shown in FIG. 3 due to the displacement of the receiving portion 318 in the positive direction of the Y axis. In this case, since the second tilting portion 313B and the second beam 321B are tilted clockwise, the third measurement portion D3 is displaced in the positive direction of the Z axis, and the fourth measurement portion D4 is displaced in the negative direction of the Z axis.

第3変形要素310Cは、受力部318のY軸正方向への変位によって、図4に示すような引張力の作用を受ける。この場合、第3傾動部313C及び第3梁321Cが時計回りに傾動するため、第5計測部位D5はZ軸正方向に変位し、第6計測部位D6はZ軸負方向に変位する。 The third deformation element 310C is subjected to the action of a tensile force as shown in FIG. 4 due to the displacement of the receiving portion 318 in the positive direction of the Y axis. In this case, since the third tilting portion 313C and the third beam 321C are tilted clockwise, the fifth measurement portion D5 is displaced in the positive direction of the Z axis, and the sixth measurement portion D6 is displaced in the negative direction of the Z axis.

第4変形要素310Dは、受力部319のY軸正方向への変位によって、図4に示すような引張力の作用を受ける。この場合、第4傾動部313D及び第4梁321Dが反時計回りに傾動するため、第7計測部位D7はZ軸負方向に変位し、第8計測部位D8はZ軸正方向に変位する。 The fourth deformation element 310D is subjected to the action of a tensile force as shown in FIG. 4 due to the displacement of the receiving portion 319 in the positive direction of the Y axis. In this case, since the fourth tilting portion 313D and the fourth beam 321D are tilted counterclockwise, the seventh measurement portion D7 is displaced in the negative direction of the Z axis, and the eighth measurement portion D8 is displaced in the positive direction of the Z axis.

(3−2−3.力+Fzが作用した場合)
次に、図22は、受力部318、319にZ軸正方向の力+Fzが作用したときに、図17の基本構造300の各変位体320A〜320Dに生じる変位を説明するための図である。
(3-2-3. When force + Fz acts)
Next, FIG. 22 is a diagram for explaining the displacements that occur in the displacement bodies 320A to 320D of the basic structure 300 of FIG. 17 when a force + Fz in the Z-axis positive direction acts on the force receiving portions 318 and 319. be.

受力体360を介して受力部318、319にZ軸正方向の力+Fzが作用すると、図22に示すように、受力部318、319がZ軸正方向へ変位する。このことにより、第1〜第4変形要素310A〜310Dは、いずれも、図6に示すような上向きの力の作用を受ける。この場合、第1傾動部313A及び第3傾動部313Cが時計回りに傾動するため、第1梁321A及び第3梁321Cも時計回りに傾動する。この結果、第1計測部位D1及び第5計測部位D5はZ軸正方向に変位し、第2計測部位D2及び第6計測部位D6はZ軸負方向に変位する。 When a force + Fz in the Z-axis positive direction acts on the receiving portions 318 and 319 via the receiving body 360, the receiving portions 318 and 319 are displaced in the Z-axis positive direction as shown in FIG. As a result, the first to fourth deformable elements 310A to 310D are all subjected to the action of the upward force as shown in FIG. In this case, since the first tilting portion 313A and the third tilting portion 313C are tilted clockwise, the first beam 321A and the third beam 321C are also tilted clockwise. As a result, the first measurement site D1 and the fifth measurement site D5 are displaced in the positive direction of the Z axis, and the second measurement site D2 and the sixth measurement site D6 are displaced in the negative direction of the Z axis.

一方、第2傾動部313B及び第4傾動部313Dは、反時計回りに傾動するため、第2梁321B及び第4梁321Dも反時計回りに傾動する。この結果、第3計測部位D3及び第7計測部位D7はZ軸負方向に変位し、第4計測部位D4及び第8計測部位D8はZ軸正方向に変位する。 On the other hand, since the second tilting portion 313B and the fourth tilting portion 313D tilt counterclockwise, the second beam 321B and the fourth beam 321D also tilt counterclockwise. As a result, the third measurement site D3 and the seventh measurement site D7 are displaced in the negative direction of the Z axis, and the fourth measurement site D4 and the eighth measurement site D8 are displaced in the positive direction of the Z axis.

(3−2−4.モーメント+Mxが作用した場合)
次に、図23は、受力部318、319にX軸正まわりのモーメント+Mxが作用したときに、図17の基本構造300の各変位体320A〜320Dに生じる変位を説明するための図である。なお、本願では、所定の座標軸の正方向に右ネジを進める場合の当該右ネジの回転方向を、当該座標軸まわりの正のモーメントと定義することにする。
(3-2-4. When moment + Mx acts)
Next, FIG. 23 is a diagram for explaining the displacements that occur in the displacement bodies 320A to 320D of the basic structure 300 of FIG. 17 when the moment + Mx around the X-axis is applied to the receiving portions 318 and 319. be. In the present application, the rotation direction of the right-hand screw when the right-hand screw is advanced in the positive direction of the predetermined coordinate axis is defined as a positive moment around the coordinate axis.

受力体360を介して受力部318、319にX軸正まわりのモーメント+Mxが作用すると、各受力部318、319のうち、Y軸正側(図23における上側)の部位がZ軸正方向(手前側)に変位し、Y軸負側(図23における下側)の部位がZ軸負方向(奥側)に変位する。すなわち、第1変形要素310A及び第2変形要素310Bには、図22と同じ方向に力が作用する。したがって、3−2−3.で説明したように、第1計測部位D1はZ軸正方向に変位し、第2計測部位D2はZ軸負方向に変位し、第3計測部位D3はZ軸負方向に変位し、第4計測部位D4はZ軸正方向に変位する。 When a moment + Mx around the X-axis positive direction acts on the receiving portions 318 and 319 via the receiving body 360, the portion of each receiving portion 318 and 319 on the positive side of the Y-axis (upper side in FIG. 23) is the Z-axis. It is displaced in the positive direction (front side), and the portion on the negative side of the Y axis (lower side in FIG. 23) is displaced in the negative direction of the Z axis (back side). That is, a force acts on the first deforming element 310A and the second deforming element 310B in the same direction as in FIG. 22. Therefore, 3-2-3. As explained in the above, the first measurement part D1 is displaced in the positive direction of the Z axis, the second measurement part D2 is displaced in the negative direction of the Z axis, the third measurement part D3 is displaced in the negative direction of the Z axis, and the fourth The measurement site D4 is displaced in the positive direction of the Z axis.

一方、第3変形要素310Cは、受力部319から、図5に示すような下向きの力の作用を受ける。この場合、第3傾動部313Cが反時計回りに傾動するため、第3梁321Cも反時計回りに傾動する。この結果、第5計測部位D5はZ軸負方向に変位し、第6計測部位D6はZ軸正方向に変位する。 On the other hand, the third deformation element 310C is subjected to the action of a downward force as shown in FIG. 5 from the receiving portion 319. In this case, since the third tilting portion 313C tilts counterclockwise, the third beam 321C also tilts counterclockwise. As a result, the fifth measurement site D5 is displaced in the negative direction of the Z axis, and the sixth measurement site D6 is displaced in the positive direction of the Z axis.

第4変形要素310Dは、受力部318から、図5に示すような下向きの力の作用を受ける。この場合、第4傾動部313Dが時計回りに傾動するため、第4梁321Dも時計回りに傾動する。この結果、第7計測部位D7はZ軸正方向に変位し、第8計測部位D8はZ軸正方向に変位する。 The fourth deformation element 310D is subjected to the action of a downward force as shown in FIG. 5 from the receiving portion 318. In this case, since the fourth tilting portion 313D tilts clockwise, the fourth beam 321D also tilts clockwise. As a result, the 7th measurement site D7 is displaced in the Z-axis positive direction, and the 8th measurement site D8 is displaced in the Z-axis positive direction.

(3−2−5.モーメント+Myが作用した場合)
次に、図24は、受力部318、319にY軸正まわりのモーメント+Myが作用したときに、図17の基本構造300の各変位体320A〜320Dに生じる変位を説明するための図である。
(3-2-5. When moment + My acts)
Next, FIG. 24 is a diagram for explaining the displacements that occur in the displacement bodies 320A to 320D of the basic structure 300 of FIG. 17 when the moment + My in the positive direction of the Y axis acts on the receiving portions 318 and 319. be.

受力体360を介して受力部318、319にY軸正まわりのモーメント+Myが作用すると、X軸負側に位置する受力部319は、Z軸正方向(図24における奥から手前に向かう方向)に変位し、X軸正側に位置する受力部318は、Z軸負方向(図24における手前から奥に向かう方向)に変位する。すなわち、第1変形要素310A及び第4変形要素310Dには、図22と同じ方向に力が作用する。したがって、3−2−3.で説明したように、第1計測部位D1はZ軸正方向に変位し、第2計測部位D2はZ軸負方向に変位し、第7計測部位D7はZ軸負方向に変位し、第8計測部位D8はZ軸正方向に変位する。 When a moment + My in the positive direction of the Y axis acts on the receiving portions 318 and 319 via the receiving body 360, the receiving portion 319 located on the negative side of the X axis moves in the positive direction of the Z axis (from the back to the front in FIG. 24). The force receiving portion 318 located on the positive side of the X-axis is displaced in the negative direction of the Z-axis (the direction from the front to the back in FIG. 24). That is, a force acts on the first deforming element 310A and the fourth deforming element 310D in the same direction as in FIG. 22. Therefore, 3-2-3. As explained in the above, the first measurement part D1 is displaced in the positive direction of the Z axis, the second measurement part D2 is displaced in the negative direction of the Z axis, the seventh measurement part D7 is displaced in the negative direction of the Z axis, and the eighth The measurement site D8 is displaced in the positive direction of the Z axis.

一方、図24に示すように、第2変形要素310B及び第3変形要素310Cは、Z軸負方向の力の作用を受ける(図5参照)。このような力の作用により、第2変形要素310Bでは、第2傾動部313Bが時計回りに傾動するため、第2梁321Bも時計回りに傾動する。この結果、第3計測部位D3はZ軸正方向に変位し、第4計測部位D4はZ軸負方向に変位する。第3変形要素310Cでは、図23と同様に、第3傾動部313Cが反時計回りに傾動することにより、第5計測部位D5はZ軸負方向に変位し、第6計測部位D6はZ軸正方向に変位する。 On the other hand, as shown in FIG. 24, the second deformation element 310B and the third deformation element 310C are affected by the force in the negative direction of the Z axis (see FIG. 5). Due to the action of such a force, the second tilting portion 313B tilts clockwise in the second deforming element 310B, so that the second beam 321B also tilts clockwise. As a result, the third measurement site D3 is displaced in the positive direction of the Z axis, and the fourth measurement site D4 is displaced in the negative direction of the Z axis. In the third deformation element 310C, as in FIG. 23, the third tilting portion 313C is tilted counterclockwise, so that the fifth measurement portion D5 is displaced in the negative Z-axis direction, and the sixth measurement portion D6 is the Z-axis. Displace in the positive direction.

(3−2−6.モーメント+Mzが作用した場合)
次に、図25は、受力部318、319にZ軸正まわりのモーメント+Mzが作用したときに、図17の基本構造300の各変位体320A〜320Dに生じる変位を説明するための図である。
(3-2-6. When moment + Mz acts)
Next, FIG. 25 is a diagram for explaining the displacements that occur in the displacement bodies 320A to 320D of the basic structure 300 of FIG. 17 when the moment + Mz around the Z-axis forward acts on the receiving portions 318 and 319. be.

受力体360を介して受力部318、319にZ軸正まわりのモーメント+Mzが作用すると、X軸負側に位置する受力部319がY軸負方向へ変位し、X軸正側に位置する受力部318がY軸正方向へ変位する。X軸正側に位置する受力部318の変位は、力+Fyが作用した場合と同じ向きであるため(図21参照)、X軸正側に配置された第2変形要素310B及び第3変形要素310Cには、図21と同じ弾性変形が生じる。すなわち、第3計測部位D3はZ軸正方向に変位し、第4計測部位D4はZ軸負方向に変位し、第5計測部位D5はZ軸正方向に変位し、第6計測部位D6はZ軸負方向に変位する。 When a moment + Mz in the positive direction of the Z axis acts on the receiving portions 318 and 319 via the receiving body 360, the receiving portion 319 located on the negative side of the X axis is displaced in the negative direction of the Y axis and moves to the positive side of the X axis. The positioned force receiving portion 318 is displaced in the positive direction of the Y axis. Since the displacement of the receiving portion 318 located on the positive side of the X-axis is in the same direction as when the force + Fy is applied (see FIG. 21), the second deformation element 310B and the third deformation arranged on the positive side of the X-axis The element 310C undergoes the same elastic deformation as in FIG. That is, the third measurement site D3 is displaced in the positive direction of the Z axis, the fourth measurement site D4 is displaced in the negative direction of the Z axis, the fifth measurement site D5 is displaced in the positive direction of the Z axis, and the sixth measurement site D6 is displaced. Displace in the negative direction of the Z axis.

一方、第1変形要素310Aは、受力部319のY軸負方向への変位によって、図4に示すような引張力の作用を受ける。この場合、第1傾動部313A及び第1梁321Aが時計回りに傾動するため、第1計測部位D1はZ軸正方向に変位し、第2計測部位D2はZ軸負方向に変位する。 On the other hand, the first deforming element 310A is subjected to the action of the tensile force as shown in FIG. 4 due to the displacement of the receiving portion 319 in the negative direction of the Y axis. In this case, since the first tilting portion 313A and the first beam 321A are tilted clockwise, the first measuring portion D1 is displaced in the positive direction of the Z axis, and the second measuring portion D2 is displaced in the negative direction of the Z axis.

また、第4変形要素310Dは、受力部319のY軸負方向への変位によって、図3に示すような圧縮力の作用を受ける。この場合、第4傾動部313D及び第4梁321Dが時計回りに傾動するため、第7計測部位D7はZ軸正方向に変位し、第8計測部位D8はZ軸負方向に変位する。 Further, the fourth deformation element 310D is subjected to the action of a compressive force as shown in FIG. 3 due to the displacement of the receiving portion 319 in the negative direction of the Y axis. In this case, since the fourth tilting portion 313D and the fourth beam 321D are tilted clockwise, the seventh measurement portion D7 is displaced in the positive direction of the Z axis, and the eighth measurement portion D8 is displaced in the negative direction of the Z axis.

以上のまとめとして、図26には、受力部318、319にXYZ三次元座標系の各軸方向の力+Fx、+Fy、+Fz及び各軸まわりのモーメント+Mx、+My、+Mzが作用したときに図17の基本構造300の各傾動部313A〜313Dに生じる傾動の向きと、各変位体320A〜320Bの各計測部位D1〜D8に生じる変位とが、一覧で示されている。図26において、各傾動部313A〜313Dの欄に記された回動の向き(時計回り/反時計回り)は、原点Oから観測したときの向きである。また、各計測部位D1〜D8の欄に記された「+」の記号は、対応する変位部と支持体350との離間距離が増大することを意味し、「−」の記号は、対応する変位部と支持体350との離間距離が減少することを意味している。 As a summary of the above, FIG. 26 shows a diagram when a force + Fx, + Fy, + Fz in each axis direction of the XYZ three-dimensional coordinate system and a moment + Mx, + My, + Mz around each axis act on the receiving units 318 and 319. The direction of tilt occurring in each of the tilting portions 313A to 313D of the basic structure 300 of 17, and the displacement occurring in each of the measurement sites D1 to D8 of each of the displacement bodies 320A to 320B are shown in a list. In FIG. 26, the direction of rotation (clockwise / counterclockwise) described in the columns of the tilting portions 313A to 313D is the direction when observed from the origin O. Further, the "+" symbol in the columns of the measurement sites D1 to D8 means that the distance between the corresponding displacement portion and the support 350 increases, and the "-" symbol corresponds to the corresponding displacement portion. This means that the separation distance between the displacement portion and the support 350 is reduced.

なお、受力体360に作用する力及びモーメントが負方向及び負まわりである場合には、上述した各場合において、傾動部313A〜313Dの傾動の向きが全て逆になる。この結果、各変位体320A〜320Dの計測部位D1〜D8に生じる変位の向きも逆になり、図26に一覧で示した傾動の向き、及び、各計測部位D1〜D8と支持体350との離間距離の増減(+/−)が、全て逆になる。 When the force and the moment acting on the receiving body 360 are in the negative direction and the negative rotation, the tilting directions of the tilting portions 313A to 313D are all reversed in each of the above cases. As a result, the directions of displacements that occur in the measurement sites D1 to D8 of the displacement bodies 320A to 320D are also reversed, and the tilt directions listed in FIG. The increase / decrease (+/-) of the separation distance is all reversed.

< 3−3. 力覚センサの構成 >
次に、3−1、3−2において説明した基本構造300を有する力覚センサ300cの構成について説明する。
<3-3. Force sensor configuration >
Next, the configuration of the force sensor 300c having the basic structure 300 described in 3-1 and 3-2 will be described.

図27は、図17に示す基本構造300を採用した力覚センサ300cの一例を示す概略上面図であり、図28は、Y軸正側から見た、図27に示す力覚センサ300cを示す概略正面図である。 27 is a schematic top view showing an example of the force sensor 300c adopting the basic structure 300 shown in FIG. 17, and FIG. 28 shows the force sensor 300c shown in FIG. 27 as viewed from the positive side of the Y-axis. It is a schematic front view.

図27及び図28に示すように、力覚センサ300cは、上述した基本構造300と、基本構造300の変位体320A〜320Dの各計測部位D1〜D8に生じる変位に基づいて、作用した力及びモーメントを検出する検出回路340と、を有している。本実施の形態の検出回路340は、図27及び図28に示すように、各変位体320A〜320Dの各計測部位D1〜D8に2つずつ配置された、合計16個の容量素子C11〜C82と、これらの容量素子C11〜C82に接続され、当該容量素子C11〜C82の静電容量値の変動量に基づいて、作用した力を計測するマイコン344と、を有している。 As shown in FIGS. 27 and 28, the force sensor 300c is based on the above-mentioned basic structure 300 and the displacements generated in the measurement sites D1 to D8 of the displacement bodies 320A to 320D of the basic structure 300, and the acting force and the force. It has a detection circuit 340 for detecting a moment. As shown in FIGS. 27 and 28, the detection circuit 340 of the present embodiment has a total of 16 capacitive elements C11 to C82 arranged in each of the measurement sites D1 to D8 of the displacement bodies 320A to 320D. And a microcomputer 344 connected to these capacitance elements C11 to C82 and measuring the acting force based on the fluctuation amount of the capacitance value of the capacitance elements C11 to C82.

容量素子C11〜C82の具体的な配置は次の通りである。すなわち、図27及び図28に示すように、第1−1容量素子C11及び第2−1容量素子C21は、第1梁321Aと第1接続体322Aとの接続部位に関して対称的に配置されており、第1−2容量素子C12及び第2−2容量素子C22は、第1−1容量素子C11と第2−1容量素子C21との間に、当該接続部位に関して対称的に配置されている。この他の容量素子も同様に配置されている。すなわち、第3−1容量素子C31及び第4−1容量素子C41は、第2梁321Bと第2接続体322Bとの接続部位に関して対称的に配置されており、第3−2容量素子C32及び第4−2容量素子C42は、第3−1容量素子C31と第4−1容量素子C41との間に、当該接続部位に関して対称的に配置されている。第5−1容量素子C51及び第6−1容量素子C61は、第3梁321Cと第3接続体322Cとの接続部位に関して対称的に配置されており、第5−2容量素子C52及び第6−2容量素子C62は、第5−1容量素子C51と第6−1容量素子C61との間に、当該接続部位に関して対称的に配置されている。更に、第7−1容量素子C71及び第8−1容量素子C81は、第4梁321Dと第4接続体322Dとの接続部位に関して対称的に配置されており、第7−2容量素子C72及び第8−2容量素子C82は、第7−1容量素子C71と第8−1容量素子C81との間に、当該接続部位に関して対称的に配置されている。 The specific arrangement of the capacitive elements C11 to C82 is as follows. That is, as shown in FIGS. 27 and 28, the 1-1 capacitance element C11 and the 2-1 capacitance element C21 are arranged symmetrically with respect to the connection portion between the first beam 321A and the first connector 322A. The first and second capacitance elements C12 and the second and second capacitance elements C22 are arranged symmetrically with respect to the connection portion between the first and second capacitance elements C11 and the 2-1 capacitance element C21. .. Other capacitive elements are also arranged in the same manner. That is, the 3-1st capacitive element C31 and the 4-1th capacitive element C41 are symmetrically arranged with respect to the connection portion between the second beam 321B and the second connecting body 322B, and the 3rd-2nd capacitive element C32 and the 3rd capacitive element C32 and the second connecting body 322B are arranged symmetrically. The 4-2nd capacitance element C42 is arranged symmetrically with respect to the connection portion between the 3-1st capacitance element C31 and the 4-1th capacitance element C41. The 5-1st capacitive element C51 and the 6-1th capacitive element C61 are arranged symmetrically with respect to the connection portion between the third beam 321C and the third connecting body 322C, and the 5-2nd capacitive element C52 and the sixth are arranged. The -2 capacitance element C62 is arranged symmetrically with respect to the connection portion between the 5-1 capacitance element C51 and the 6-1 capacitance element C61. Further, the 7-1 capacitance element C71 and the 8-1 capacitance element C81 are symmetrically arranged with respect to the connection portion between the 4th beam 321D and the 4th connecting body 322D, and the 7-2 capacitance element C72 and the 8-1 capacitance element C81 are arranged symmetrically. The 8th-2nd capacitive element C82 is arranged symmetrically with respect to the connection portion between the 7-1th capacitive element C71 and the 8-1th capacitive element C81.

後述されるように、各梁321A〜321Dの外側に配置された8つの容量素子Cn1(n=1、2、・・・8)が、第1変位センサとして作用した力及びモーメントを示す第1電気信号T1を出力するために用いられ、各梁321A〜321Dの内側に配置された8つの容量素子Cn2(n=1、2、・・・8)が、第2変位センサとして作用した力及びモーメントを示す第2電気信号T2を計測するために用いられる。 As will be described later, the first one showing the force and moment that the eight capacitive elements Cn1 (n = 1, 2, ... 8) arranged outside each of the beams 321A to 321D acted as the first displacement sensor. Eight capacitive elements Cn2 (n = 1, 2, ... 8) used to output the electric signal T1 and arranged inside each beam 321A to 321D act as a second displacement sensor and the force. It is used to measure the second electric signal T2 indicating the moment.

各容量素子C11〜C82の具体的な構成は、図7に示す力覚センサ100cの各容量素子C11〜C22と同様である。すなわち、第n計測部位Dn(n=1、2、・・・、8)に配置されている第n−1容量素子Cn1(n=1、2、・・・、8)は、第n計測部位Dnに絶縁体(不図示)を介して配置された第n−1変位電極Emn1(n=1、2、・・・、8)と、支持体350上に絶縁体(不図示)を介し第n−1変位電極Emn1と対向配置された第n−1固定電極Efn1(n=1、2、・・・、8)と、を有している。また、第n−2容量素子Cn2(n=1、2、・・・、8)は、第n計測部位Dn(n=1、2、・・・、8)に第n−1変位電極Emn1に隣接して絶縁体(不図示)を介して配置された第n−2変位電極Emn2(n=1、2、・・・、8)と、支持体250上に絶縁体(不図示)を介し第n−2変位電極Emn2と対向配置された第n−2固定電極Efn2(n=1、2、・・・、8)と、を有している。 The specific configuration of the capacitance elements C11 to C82 is the same as that of the capacitance elements C11 to C22 of the force sensor 100c shown in FIG. 7. That is, the n-1th capacitive element Cn1 (n = 1, 2, ..., 8) arranged at the nth measurement site Dn (n = 1, 2, ..., 8) is the nth measurement. The n-1th displacement electrode Emn1 (n = 1, 2, ..., 8) arranged at the portion Dn via an insulator (not shown) and the insulator 350 on the support 350 via an insulator (not shown). It has an n-1 fixed electrode Efn1 (n = 1, 2, ..., 8) arranged to face the n-1th displacement electrode Emn1. Further, the n-2nd capacitive element Cn2 (n = 1, 2, ..., 8) has the n-1th displacement electrode Emn1 at the nth measurement site Dn (n = 1, 2, ..., 8). The n-2nd displacement electrode Emn2 (n = 1, 2, ..., 8) arranged adjacent to the support 250 via an insulator (not shown) and an insulator (not shown) are placed on the support 250. It has the n-2nd fixed electrode Efn2 (n = 1, 2, ..., 8) arranged to face the n-2th displacement electrode Emn2.

これらの容量素子C11〜C82は、図27及び図28には明確には図示されていないが、所定の回路によってマイコン344に接続されており、各容量素子C11〜C82の静電容量値が当該マイコン344に提供されるようになっている。 Although these capacitance elements C11 to C82 are not clearly shown in FIGS. 27 and 28, they are connected to the microcomputer 344 by a predetermined circuit, and the capacitance values of the capacitance elements C11 to C82 are the relevant capacitance values. It is provided to the microcomputer 344.

< 2−4. 力覚センサの作用 >
次に、図29を参照して、2−3.で説明した力覚センサ200cの作用について説明する。
<2-4. Action of force sensor >
Next, with reference to FIG. 29, 2-3. The operation of the force sensor 200c described in the above will be described.

図29は、受力部318,319にXYZ三次元座標系における各軸方向の力Fx、Fy、Fz及び各軸まわりのモーメントMx、My、Mzが作用したときの、図27に示す力覚センサの各容量素子C11〜C82の静電容量値の増減を一覧で示す図表である。この図表において、「+」は、静電容量値が増大することを示しており、「++」は、静電容量値が大きく増大することを示している。また、「−」は、静電容量値が減少することを示しており、「−−」は、静電容量値が大きく減少することを示している。 FIG. 29 shows the force sensor shown in FIG. 27 when the forces Fx, Fy, Fz in each axial direction and the moments Mx, My, Mz around each axis act on the receiving units 318, 319 in the XYZ three-dimensional coordinate system. It is a chart which shows the increase / decrease of the capacitance value of each capacitance element C11-C82 of a sensor in a list. In this chart, "+" indicates that the capacitance value increases, and "++" indicates that the capacitance value increases significantly. Further, "-" indicates that the capacitance value decreases, and "-" indicates that the capacitance value decreases significantly.

図29に示されている各容量素子C11〜C82の静電容量値の符号(正か負か)については、図26に示す基本構造300の各計測部位D1〜D8に生じる変位から明らかである。また、各容量素子C11〜C82の静電容量値の変動の大きさは、傾動部313A〜313Dと梁321A〜321Dとの接続部位から、すなわち各梁321A〜321Dの傾動の中心から、各容量素子C11〜C22までの距離を考慮することにより理解される。すなわち、各梁321A〜321Dの傾動の中心から相対的に遠位に配置された8つの容量素子Cn1(n=1、2、・・・8)(第1変位センサ)では、静電容量値の変動が相対的に大きく、相対的に当該傾動の中心の近位に配置された8つの容量素子Cn2(n=1、2、・・・8)(第2変位センサ)では、静電容量値の変動が相対的に小さい。 The sign (positive or negative) of the capacitance value of each capacitance element C11 to C82 shown in FIG. 29 is clear from the displacement occurring in each measurement portion D1 to D8 of the basic structure 300 shown in FIG. .. Further, the magnitude of the fluctuation of the capacitance value of each capacitance element C11 to C82 is determined from the connection portion between the tilting portions 313A to 313D and the beams 321A to 321D, that is, from the center of tilting of the beams 321A to 321D. It is understood by considering the distances from the elements C11 to C22. That is, in the eight capacitance elements Cn1 (n = 1, 2, ... 8) (first displacement sensor) arranged relatively distal to the center of tilt of each beam 321A to 321D, the capacitance value The capacitance of the eight capacitive elements Cn2 (n = 1, 2, ... 8) (second displacement sensor) arranged relatively proximal to the center of the tilt is relatively large. The fluctuation of the value is relatively small.

以上から、上記1−4.と同様に考えることにより、受力部318,319に作用した各軸方向の力Fx、Fy、Fz及び各軸まわりのモーメントMx、My、Mzは、次の[式6]及び[式7]のいずれかにより計測される。各式の左辺の末尾の数字「1」及び「2」は、力及びモーメントが、容量素子Cn1(n=1、2、・・・8)(第1変位センサ)から計測されたのか、あるいは容量素子Cn2(n=1、2、・・・8)(第2変位センサ)から計測されたのか、を区別するための符号である。
[式6]
+Fx1=C11−C21+C31−C41−C51+C61−C71+C81
+Fy1=C11−C21−C31+C41−C51+C61+C71−C81
+Fz1=−C11+C21+C31−C41−C51+C61+C71−C81
+Mx1=−C11+C21+C31−C41+C51−C61−C71+C81
+My1=−C11+C21−C31+C41+C51−C61+C71−C81
+Mz1=−C11+C21−C31+C41−C51+C61−C71+C81
[式7]
+Fx2=C12−C22+C32−C42−C52+C62−C72+C82
+Fy2=C12−C22−C32+C42−C52+C62+C72−C82
+Fz2=−C12+C22+C32−C42−C52+C62+C72−C82
+Mx2=−C12+C22+C32−C42+C52−C62−C72+C82
+My2=−C12+C22−C32+C42+C52−C62+C72−C82
+Mz2=−C12+C22−C32+C42−C52+C62−C72+C82
From the above, the above 1-4. The forces Fx, Fy, Fz in each axial direction and the moments Mx, My, Mz around each axis acting on the receiving portions 318, 319 are calculated in the same manner as in the following [Equation 6] and [Equation 7]. It is measured by either of. The numbers "1" and "2" at the end of the left side of each equation indicate whether the force and moment were measured from the capacitive element Cn1 (n = 1, 2, ... 8) (first displacement sensor). It is a code for distinguishing whether it was measured from the capacitive element Cn2 (n = 1, 2, ... 8) (second displacement sensor).
[Equation 6]
+ Fx1 = C11-C21 + C31-C41-C51 + C61-C71 + C81
+ Fy1 = C11-C21-C31 + C41-C51 + C61 + C71-C81
+ Fz1 = -C11 + C21 + C31-C41-C51 + C61 + C71-C81
+ Mx1 = -C11 + C21 + C31-C41 + C51-C61-C71 + C81
+ My1 = -C11 + C21-C31 + C41 + C51-C61 + C71-C81
+ Mz1 = -C11 + C21-C31 + C41-C51 + C61-C71 + C81
[Equation 7]
+ Fx2 = C12-C22 + C32-C42-C52 + C62-C72 + C82
+ Fy2 = C12-C22-C32 + C42-C52 + C62 + C72-C82
+ Fz2 = -C12 + C22 + C32-C42-C52 + C62 + C72-C82
+ Mx2 = -C12 + C22 + C32-C42 + C52-C62-C72 + C82
+ My2 = -C12 + C22-C32 + C42 + C52-C62 + C72-C82
+ Mz2 = -C12 + C22-C32 + C42-C52 + C62-C72 + C82

もちろん、次の[式8]に示す[式6]と[式7]との和によって、各力Fx〜Fz及びモーメントMx、My、Mzを計測しても良い。[式6]と[式7]との和による式の末尾には「3」を付して、[式6]及び[式7]と区別している。ここでは、検出回路340からの、[式6]に対応する電気信号を第1電気信号T1と呼び、[式7]に対応する電気信号を第2電気信号T2と呼び、[式8]に対応する電気信号を合算電気信号T3と呼ぶことにする。
[式8]
+Fx3=Fx1+Fx2
+Fy3=Fy1+Fy2
+Fz3=Fz1+Fz2
+Mx3=Mx1+Mx2
+My3=My1+My2
+Mz3=Mz1+Mz2
Of course, each force Fx to Fz and moments Mx, My, Mz may be measured by the sum of [Equation 6] and [Equation 7] shown in the following [Equation 8]. The sum of [Equation 6] and [Equation 7] is added with "3" at the end to distinguish it from [Equation 6] and [Equation 7]. Here, the electric signal corresponding to [Equation 6] from the detection circuit 340 is referred to as a first electric signal T1, the electric signal corresponding to [Equation 7] is referred to as a second electric signal T2, and is referred to in [Equation 8]. The corresponding electric signal will be referred to as a total electric signal T3.
[Equation 8]
+ Fx3 = Fx1 + Fx2
+ Fy3 = Fy1 + Fy2
+ Fz3 = Fz1 + Fz2
+ Mx3 = Mx1 + Mx2
+ My3 = My1 + My2
+ Mz3 = Mz1 + Mz2

なお、力覚センサ300cの受力体360に負方向の力−Fx、−Fy、−Fzまたは負まわりのモーメント−Mx、−My、−Mzが作用した場合は、前述したように、各容量素子C11〜C82の電極間の離間距離の増減が図29とは逆になる。このため、力−Fx、−Fy、−Fzまたはモーメント−Mx、−My、−Mzを検出するには、[式6]〜[式8]の右辺及び左辺の符号を全て逆にすればよい。結局、負の力及び負のモーメントが作用しても、[式6]〜[式8]によって力及びモーメントが計測されることになる。 When a force in the negative direction -Fx, -Fy, -Fz or a negative moment -Mx, -My, -Mz acts on the receiving body 360 of the force sensor 300c, each capacitance is as described above. The increase / decrease in the separation distance between the electrodes of the elements C11 to C82 is opposite to that in FIG. 29. Therefore, in order to detect the force -Fx, -Fy, -Fz or the moment -Mx, -My, -Mz, all the signs on the right side and the left side of [Equation 6] to [Equation 8] may be reversed. .. After all, even if a negative force and a negative moment act, the force and the moment are measured by [Equation 6] to [Equation 8].

力Fx、Fy、Fz及びモーメントMx、My、Mzを計測するに当たっては、S/Nの観点から、各梁321A〜321Dの傾動の中心から遠位にあり静電容量値の変動量が相対的に大きい容量素子C1n(n=1,2,・・・,8)(第1変位センサ)に基づく第1電気信号T1([式6]に対応)、または、全ての容量素子C11〜C82に基づく合算電気信号T3([式8]に対応)、を用いることが好ましい。 In measuring the forces Fx, Fy, Fz and the moments Mx, My, Mz, from the viewpoint of S / N, each beam 321A to 321D is distal to the center of tilt, and the amount of variation in the capacitance value is relative. For the first electric signal T1 (corresponding to [Equation 6]) based on the large capacitive element C1n (n = 1, 2, ..., 8) (first displacement sensor), or for all the capacitive elements C11 to C82. It is preferable to use the total electric signal T3 (corresponding to [Equation 8]) based on the above.

< 3−5. 力覚センサの他軸感度 >
次に、図30を参照して、本実施の形態による力覚センサ300cの他軸感度について説明する。図30は、図27に示す力覚センサ300cにおける、各軸方向の力Fx、Fy、Fz及び各軸まわりのモーメントMx、My、Mzの他軸感度VFx〜VMzを一覧で示す図表である。
<3-5. Other axis sensitivity of force sensor >
Next, with reference to FIG. 30, the other axis sensitivity of the force sensor 300c according to the present embodiment will be described. FIG. 30 is a chart showing a list of forces Fx, Fy, Fz in each axial direction and other axial sensitivities VFx to VMz of moments Mx, My, and Mz around each axis in the force sensor 300c shown in FIG. 27.

図30の図表中に配された数字は、図29に示す図表の各力Fx、Fy、Fz及び各モーメントMx、My、Mzについて、「+」の記号が付された容量素子を+1とし、「−」の記号が付された容量素子を−1として、上述した[式6]または[式7]の右辺に代入して得られた値である。すなわち、列Fxと行VFxとが交わるマス目に記された「8」という数字は、[式6]のFxの式において、図29のFxの行に基づき、C11=C31=C61=C81=+1とし、C21=C41=C51=C71=−1として得られた値である。また、列FxとVFyとが交わるマス目に記された「0」という数字は、[式6]のFxを示す式において、図29のFyの行に基づき、C11=C41=C61=C71=+1とし、C21=C31=C51=C82=−1として得られた値である。その他のマス目の数字についても同様である。 The numbers arranged in the chart of FIG. 30 are such that the capacitive element with the symbol “+” is +1 for each force Fx, Fy, Fz and each moment Mx, My, Mz in the chart shown in FIG. 29. It is a value obtained by substituting the capacitive element with the symbol "-" as -1 and substituting it on the right side of the above-mentioned [Equation 6] or [Equation 7]. That is, the number "8" written in the square where the column Fx and the row VFx intersect is based on the row of Fx in FIG. 29 in the formula of Fx in [Equation 6], and C11 = C31 = C61 = C81 = It is a value obtained by setting +1 and C21 = C41 = C51 = C71 = -1. Further, the number "0" written in the square where the columns Fx and VFy intersect is based on the row of Fy in FIG. 29 in the formula showing Fx in [Equation 6], and C11 = C41 = C61 = C71 = It is a value obtained by setting +1 and C21 = C31 = C51 = C82 = -1. The same applies to the numbers in other squares.

図30によれば、FxとMyの他軸感度、及び、FyとMxの他軸感度が100%となっている。すなわち、力覚センサ200cは、FxとMyとを区別することができず、FyとMxとを区別することもできない。このことは、[式6]及び[式7]の+Fxの式と+Myの式とが互いに異符号の関係にあり、+Fyの式と+Mxの式とが互いに異符号の関係にあることからも、理解できる。このため、力覚センサ300cは、各軸方向の力Fx、Fy、Fz及び各軸まわりのモーメントMx、My、Mzの全てを検出することはできない。しかしながら、Fx及びFyが作用しない用途、あるいは、Mx及びMyが作用しない用途に限定して用いることにより、力覚センサ300cを有用に活用することができる。 According to FIG. 30, the other axis sensitivity of Fx and My and the other axis sensitivity of Fy and Mx are 100%. That is, the force sensor 200c cannot distinguish between Fx and My, nor can it distinguish between Fy and Mx. This is also because the + Fx equation and the + My equation in [Equation 6] and [Equation 7] have a different sign relationship with each other, and the + Fy equation and the + Mx equation have a different sign relationship with each other. ,Understandable. Therefore, the force sensor 300c cannot detect all of the forces Fx, Fy, Fz in each axial direction and the moments Mx, My, Mz around each axis. However, the force sensor 300c can be effectively utilized by using it only for applications in which Fx and Fy do not act, or applications in which Mx and My do not act.

< 3−6. 故障診断 >
本実施の形態の検出回路340も、力覚センサ300cが正常に機能しているか否かを判定する機能を有している。
<3-6. Failure diagnosis >
The detection circuit 340 of the present embodiment also has a function of determining whether or not the force sensor 300c is functioning normally.

前述したように、本実施の形態の検出回路340のマイコン344は、[式6]の右辺に基づく第1電気信号T1と、[式7]の右辺に基づく第2電気信号T2と、を出力する。例えば、力Fxに着目して第1電気信号T1及び第2電気信号T2を書き下すと、次の[式9]の通りである。
[式9]
T1=C11−C21+C31−C41−C51+C61−C71+C81
T2=C12−C22+C32−C42−C52+C62−C72+C82
As described above, the microcomputer 344 of the detection circuit 340 of the present embodiment outputs the first electric signal T1 based on the right side of [Equation 6] and the second electric signal T2 based on the right side of [Equation 7]. do. For example, when the first electric signal T1 and the second electric signal T2 are written down focusing on the force Fx, it is as shown in the following [Equation 9].
[Equation 9]
T1 = C11-C21 + C31-C41-C51 + C61-C71 + C81
T2 = C12-C22 + C32-C42-C52 + C62-C72 + C82

ところで、図29に示すように、[式9]の第1電気信号T1の右辺を構成する容量素子C1n(n=1,2,・・・,8)(第1変位センサ)の静電容量値の変動量は、第2電気信号T2の右辺を構成する容量素子C2n(n=1,2,・・・,8)(第2変位センサ)の静電容量値の変動量よりも大きい。このため、例えばマイコン344の補正回路によって、第2電気信号T2に所定の補正係数kを乗じることによって、第1電気信号T1と第2電気信号T2の出力レベルを揃えることができる。 By the way, as shown in FIG. 29, the capacitance of the capacitance element C1n (n = 1, 2, ..., 8) (first displacement sensor) constituting the right side of the first electric signal T1 of [Equation 9]. The fluctuation amount of the value is larger than the fluctuation amount of the capacitance value of the capacitance elements C2n (n = 1, 2, ..., 8) (second displacement sensor) constituting the right side of the second electric signal T2. Therefore, for example, the output levels of the first electric signal T1 and the second electric signal T2 can be made uniform by multiplying the second electric signal T2 by a predetermined correction coefficient k by the correction circuit of the microcomputer 344.

そして、マイコン344に含まれる比較回路がこれら2つの電気信号T1、k・T2を比較する。この比較は、差各信号T1、k・T2の差(例:T1−k・T2)、あるいは、各信号T1、k・T2の比(例:T1/(k・T2))に基づいて行われる。そして、2つの電気信号T1、k・T2の比較の結果、T1とk・T2との差または比が所定の範囲に含まれていれば、マイコン344の診断回路は、力覚センサ300cが正常に機能していると判定する。一方、T1とT2との差が所定の範囲に含まれていなければ、マイコン344の診断回路は、力覚センサ300cが正常に機能していない(故障している)と判定し、その判定結果を故障診断信号として出力する。このような検出回路によれば、容量素子C11〜C82を構成する電極の破損、短絡、異物の混入などの異常を単一の力覚センサ300cによって検知することができる。 Then, the comparison circuit included in the microcomputer 344 compares these two electric signals T1 and k · T2. This comparison is based on the difference between the differences signals T1 and k · T2 (eg T1-k · T2) or the ratio of the signals T1 and k · T2 (eg T1 / (k · T2)). Be told. Then, as a result of comparing the two electric signals T1 and k / T2, if the difference or ratio between T1 and k / T2 is within a predetermined range, the diagnostic circuit of the microcomputer 344 has a normal force sensor 300c. Judge that it is functioning. On the other hand, if the difference between T1 and T2 is not included in the predetermined range, the diagnostic circuit of the microcomputer 344 determines that the force sensor 300c is not functioning normally (failed), and the determination result is obtained. Is output as a failure diagnosis signal. According to such a detection circuit, abnormalities such as breakage, short circuit, and mixing of foreign matter in the electrodes constituting the capacitive elements C11 to C82 can be detected by a single force sensor 300c.

もちろん、各容量素子C11〜C82の静電容量値の変動量をAD変換し、マイコン344によって各静電容量値を比較することによって、力覚センサ300cの故障を診断しても良い。 Of course, the failure of the force sensor 300c may be diagnosed by AD-converting the fluctuation amount of the capacitance values of the capacitance elements C11 to C82 and comparing the capacitance values with the microcomputer 344.

なお、以上の説明においては、力Fxに着目して第1電気信号T1及び第2電気信号T2を規定したが、この他の力Fy、Fz及びモーメントMx、My、Mzの1つまたは2つ以上に着目して第1電気信号T1及び第2電気信号T2を規定しても良い。 In the above description, the first electric signal T1 and the second electric signal T2 are defined by paying attention to the force Fx, but one or two of the other forces Fy, Fz and moments Mx, My, Mz. Focusing on the above, the first electric signal T1 and the second electric signal T2 may be defined.

以上のような本実施の形態によれば、容量素子C1n(n=1,2,・・・,8)(第1変位センサ)の静電容量値の変動量に基づく第1電気信号T1と、容量素子C2n(n=1,2,・・・,8)(第2変位センサ)の静電容量値の変動量に基づく第2電気信号T2と、を比較することにより、力覚センサ300cの故障を診断することができる。更に、力覚センサ300cにおいては、各傾動部313A〜313Dの傾動によって各計測部位D1〜D8が変位することにより、各傾動部313A〜313Dに生じる傾動を効果的に増幅させることができる。すなわち、本実施の形態によれば、低価格且つ高感度でありながら、単一の力覚センサ300cによってそれ自身の故障診断が可能である、という力覚センサ300cを提供することができる。 According to the present embodiment as described above, the first electric signal T1 based on the fluctuation amount of the capacitance value of the capacitance element C1n (n = 1, 2, ..., 8) (first displacement sensor). By comparing with the second electric signal T2 based on the fluctuation amount of the capacitance value of the capacitance element C2n (n = 1, 2, ..., 8) (second displacement sensor), the force sensor 300c Can diagnose the failure of. Further, in the force sensor 300c, the tilting of the tilting portions 313A to 313D causes the measurement sites D1 to D8 to be displaced, so that the tilting generated in the tilting portions 313A to 313D can be effectively amplified. That is, according to the present embodiment, it is possible to provide a force sensor 300c that can diagnose its own failure by a single force sensor 300c while being inexpensive and having high sensitivity.

また、[式6]及び[式7]に示すように、検出回路340は、静電容量値の差分によって作用した力Fx、Fy、Fz及びモーメントMx、My、Mzを計測するため、使用環境の温度変化や同相ノイズの影響を受けにくい力覚センサ300cを提供することができる。 Further, as shown in [Equation 6] and [Equation 7], the detection circuit 340 measures the forces Fx, Fy, Fz and the moments Mx, My, Mz acting by the difference in the capacitance values, so that the usage environment It is possible to provide a force sensor 300c that is not easily affected by temperature changes and in-phase noise.

また、各変位体320A〜320Dの一方の計測部位D1、D3、D5、D7と、他方の計測部位D2、D4、D6、D7とは、傾動部313A〜313Dと梁321A〜321Dとの接続部位に関して対称的に配置されている。このため、一方の計測部位D1、D3、D5、D7に生じる変位と他方の計測部位D2、D4、D6、D7に生じる変位とが、同じ大きさで互いに異符号となるため、作用した力及びモーメントを簡易な演算によって検出することができる。
また、検出回路340は、[式6]に対応する第1電気信号T1または[式8]に対応する合算電気信号T3に基づいて、作用した力及びモーメントを検出するため、S/Nに優れた計測が可能である。
Further, one measurement portion D1, D3, D5, D7 of each displacement body 320A to 320D and the other measurement portion D2, D4, D6, D7 are connection portions between the tilting portions 313A to 313D and the beams 321A to 321D. Are arranged symmetrically with respect to. Therefore, the displacements that occur in one measurement site D1, D3, D5, D7 and the displacements that occur in the other measurement sites D2, D4, D6, D7 have the same magnitude and different signs from each other. The moment can be detected by a simple calculation.
Further, since the detection circuit 340 detects the acting force and moment based on the first electric signal T1 corresponding to [Equation 6] or the total electric signal T3 corresponding to [Equation 8], the detection circuit 340 is excellent in S / N. Measurement is possible.

<<< §4. 本発明の第4の実施の形態による力覚センサ及びその変形例 >>>
< 4−1. 本発明の第4の実施の形態による力覚センサ >
§3で説明した力覚センサ300cは、各軸方向の力Fx、Fy、Fz及びモーメントMx、My、Mzのうち4つの成分を検出し、且つ、それらの少なくとも1つの成分に着目して力覚センサ300cの故障を診断することが可能であった。ところで、これら4つの成分を検出するためには、力覚センサ300cに必ずしも16個の容量素子C11〜C82を設ける必要は無い。ここでは、上述した力覚センサ300cの変形例として、より少ない容量素子によって4つの成分を検出可能な第4の実施の形態による力覚センサ400cについて説明する。
<<< §4. Force sensor according to the fourth embodiment of the present invention and its modification >>>
<4-1. Force sensor according to the fourth embodiment of the present invention>
The force sensor 300c described in §3 detects four components of forces Fx, Fy, Fz and moments Mx, My, and Mz in each axial direction, and focuses on at least one of these components. It was possible to diagnose the failure of the sensory sensor 300c. By the way, in order to detect these four components, it is not always necessary to provide the force sensor 300c with 16 capacitive elements C11 to C82. Here, as a modification of the above-mentioned force sensor 300c, the force sensor 400c according to the fourth embodiment capable of detecting four components with a smaller capacitance element will be described.

図31は、本発明の第4の実施の形態による力覚センサ400cを示す概略上面図である。 FIG. 31 is a schematic top view showing the force sensor 400c according to the fourth embodiment of the present invention.

図31に示すように、力覚センサ400cは、梁421A〜421Dが片持ち梁で構成されている点において、第3の実施の形態による力覚センサ300cとは異なっている。具体的には、力覚センサ400cの各梁421A〜421Dは、力覚センサ300cの各梁321A〜321Dのうち、図27の時計回りに進んだ方に位置する部位を削除した片持ち梁の構造となっている。したがって、力覚センサ400cでは、各梁421A〜421Dに各1つの計測部位D1、D3、D5、D7が規定されている。そして、これら4つの計測部位D1、D3、D5、D7に各2つ、合計8つの容量素子C11、C12、C31、C32、C51、C52、C71、C72が配置されている。各容量素子の構成は、第3の実施の形態と同じである。 As shown in FIG. 31, the force sensor 400c differs from the force sensor 300c according to the third embodiment in that the beams 421A to 421D are composed of cantilever beams. Specifically, the beams 421A to 421D of the force sensor 400c are the cantilever beams in which the portion of the beams 321A to 321D of the force sensor 300c located in the clockwise direction of FIG. 27 is deleted. It has a structure. Therefore, in the force sensor 400c, one measurement site D1, D3, D5, D7 is defined for each of the beams 421A to 421D. Then, a total of eight capacitive elements C11, C12, C31, C32, C51, C52, C71, and C72 are arranged in each of these four measurement sites D1, D3, D5, and D7. The configuration of each capacitive element is the same as that of the third embodiment.

これらの8つの容量素子は、図31には図示されていないが、所定の回路によって検出回路440のマイコン444に接続されており、各容量素子の静電容量値が当該マイコン444に提供されるようになっている。そして、後述するように、マイコン444は、各容量素子の静電容量値の変動量に基づいて、力覚センサ400cに作用した力を検出するようになっている。 Although these eight capacitive elements are not shown in FIG. 31, they are connected to the microcomputer 444 of the detection circuit 440 by a predetermined circuit, and the capacitance value of each capacitive element is provided to the microcomputer 444. It has become like. Then, as will be described later, the microcomputer 444 detects the force acting on the force sensor 400c based on the fluctuation amount of the capacitance value of each capacitance element.

力覚センサ400cのその他の構成については、第3の実施の形態と同様である。このため、第3の実施の形態と共通する構成要素に略同様の符号を付し、その詳細な説明を省略する。 Other configurations of the force sensor 400c are the same as those in the third embodiment. Therefore, substantially the same reference numerals are given to the components common to the third embodiment, and detailed description thereof will be omitted.

次に、本実施の形態による力覚センサ400cの作用について説明する。ここでは、XYZ三次元座標系における各軸方向の力Fx、Fy、Fz及び各軸周りのモーメントMx、My、Mzのうち、Fz、Mx、My及びMzの4つの成分を検出する場合について説明を行う。なお、これら4つの成分は、第3の実施の形態による力覚センサ300cが検出可能な4つの成分でもある。 Next, the operation of the force sensor 400c according to the present embodiment will be described. Here, a case of detecting four components of Fz, Mx, My, and Mz among the forces Fx, Fy, Fz in each axial direction and the moments Mx, My, and Mz around each axis in the XYZ three-dimensional coordinate system will be described. I do. It should be noted that these four components are also four components that can be detected by the force sensor 300c according to the third embodiment.

上述したように、本実施の形態による力覚センサ400cは、梁421A〜421Dが片持ち梁で構成されている点を除き、第3の実施の形態による力覚センサ300cと共通している。したがって、受力体460を介して受力部418、419に力またはモーメントが作用すると、各梁421A〜421Dの各計測部位D1、D3、D5、D7には、第3の実施の形態による力覚センサ300cの対応する計測部位D1、D3、D5、D7と同じ変位が生じる。 As described above, the force sensor 400c according to the third embodiment is common to the force sensor 300c according to the third embodiment, except that the beams 421A to 421D are composed of cantilever beams. Therefore, when a force or moment acts on the receiving portions 418 and 419 via the receiving body 460, the forces D1, D3, D5, and D7 of the respective beams 421A to 421D are subjected to the force according to the third embodiment. The same displacement as the corresponding measurement sites D1, D3, D5, D7 of the sensory sensor 300c occurs.

以上から、力覚センサ400cに力及びモーメントの4つの成分Fz、Mx、My、Mzが作用すると、各容量素子の静電容量値は、図32に一覧で示すように変動する。図中の「+/++」及び「−/−−」の記号の意味は、図29と同様である。なお、図32の図表は、図29における、力Fz及びモーメントMx、My、Mzが作用したときの8つの容量素子C11、C12、C31、C32、C51、C52、C71、C72の静電容量値の増減と、同一である。 From the above, when the four components Fz, Mx, My, and Mz of force and moment act on the force sensor 400c, the capacitance value of each capacitive element fluctuates as shown in the list in FIG. 32. The meanings of the symbols “+/++” and “− / −−” in the figure are the same as those in FIG. 29. The chart of FIG. 32 shows the capacitance values of the eight capacitive elements C11, C12, C31, C32, C51, C52, C71, and C72 when the force Fz and the moments Mx, My, and Mz act in FIG. 29. Is the same as the increase or decrease of.

このような静電容量値の変動に基づいて、マイコン444は、作用した力Fz及びモーメントMx、My、Mzを次の[式10]及び[式11]により計測する。各式は、[式6]及び[式7]のFz、Mx、My及びMzの式から、C21、C22、C41、C42、C61、C62、C81及びC82を削除したものである。各式の左辺の末尾の数字「1」及び「2」は、力及びモーメントが、容量素子Cn1(n=1、3、5、7)(第1変位センサ)から計測されたのか、あるいは容量素子Cn2(n=1、3、5、7)(第2変位センサ)から計測されたのか、を区別するための符号である。
[式10]
+Fz1=−C11+C31−C51+C71
+Mx1=−C11+C31+C51−C71
+My1=−C11−C31+C51+C71
+Mz1=−C11−C31−C51−C71
[式11]
+Fz2=−C12+C32−C52+C72
+Mx2=−C12+C32+C52−C72
+My2=−C12−C32+C52+C72
+Mz2=−C12−C32−C52−C72
Based on such a fluctuation of the capacitance value, the microcomputer 444 measures the acting force Fz and the moments Mx, My, and Mz by the following [Equation 10] and [Equation 11]. Each equation is obtained by deleting C21, C22, C41, C42, C61, C62, C81 and C82 from the equations of Fz, Mx, My and Mz of [Equation 6] and [Equation 7]. The numbers "1" and "2" at the end of the left side of each equation indicate whether the force and moment were measured from the capacitance element Cn1 (n = 1, 3, 5, 7) (first displacement sensor), or the capacitance. It is a code for distinguishing whether it was measured from the element Cn2 (n = 1, 3, 5, 7) (second displacement sensor).
[Equation 10]
+ Fz1 = -C11 + C31-C51 + C71
+ Mx1 = -C11 + C31 + C51-C71
+ My1 = -C11-C31 + C51 + C71
+ Mz1 = -C11-C31-C51-C71
[Equation 11]
+ Fz2 = -C12 + C32-C52 + C72
+ Mx2 = -C12 + C32 + C52-C72
+ My2 = -C12-C32 + C52 + C72
+ Mz2 = -C12-C32-C52-C72

もちろん、第3の実施の形態と同様に、[式10]と[式11]との和による合算電気信号によって、各力Fz及びモーメントMx、My、Mzを計測しても良い。更に、第3の実施の形態で説明したとおり、[式10]及び[式11]は、力覚センサ400cの受力体460に負方向の力−Fzまたは負まわりのモーメント−Mx、−My、−Mzが作用した場合においても成立する。 Of course, as in the third embodiment, each force Fz and moments Mx, My, and Mz may be measured by the total electric signal obtained by the sum of [Equation 10] and [Equation 11]. Further, as described in the third embodiment, in [Equation 10] and [Equation 11], the force in the negative direction -Fz or the moment in the negative direction-Mx, -My , -Mz is also established when it acts.

[式10]または[式11]に基づき、力Fz及びモーメントMx、My、Mzの他軸感度を求めると、図33に一覧で示す通りとなる。他軸感度は、図30と同様に、図32に示す図表の力Fz及びモーメントMx、My、Mzについて、「+」の記号が付された容量素子を+1とし、「−」の記号が付された容量素子を−1として、上述した[式15]のそれぞれの右辺に代入して得られた値である。図33に示すように、力Fz及びモーメントMx、My、Mzの他軸感度は、ゼロである。但し、[式10]及び[式11]によれば、Z軸まわりのモーメントMzが静電容量値の和によって求められる。このため、モーメントMzについては、力覚センサ400cの使用環境における温度変化や同相ノイズの影響を受けやすい点に注意が必要である。 When the other axis sensitivities of the force Fz and the moments Mx, My, and Mz are obtained based on [Equation 10] or [Equation 11], they are as listed in FIG. 33. As for the sensitivity of the other axis, similarly to FIG. 30, for the force Fz and the moments Mx, My, and Mz shown in FIG. 32, the capacitive element with the “+” symbol is set to +1 and the “-” symbol is added. It is a value obtained by substituting the obtained capacitive element as -1 and substituting it into the right side of each of the above-mentioned [Equation 15]. As shown in FIG. 33, the forces Fz and the other axis sensitivities of the moments Mx, My, and Mz are zero. However, according to [Equation 10] and [Equation 11], the moment Mz around the Z axis is obtained by the sum of the capacitance values. Therefore, it should be noted that the moment Mz is easily affected by temperature changes and in-phase noise in the usage environment of the force sensor 400c.

このような力覚センサ400は、当該力覚センサ400cが正常に機能しているか否かを、次のようにして判定する。 Such a force sensor 400 determines whether or not the force sensor 400c is functioning normally as follows.

検出回路440のマイコン444は、[式10]の右辺に基づく第1電気信号T1と、[式11]の右辺に基づく第2電気信号T2と、を出力するようになっている。すなわち、力Fzに着目して第1電気信号T1及び第2電気信号T2を書き下すと、次の[式12]の通りである。
[式12]
T1=−C11+C31−C51+C71
T2=−C12+C32−C52+C72
The microcomputer 444 of the detection circuit 440 outputs a first electric signal T1 based on the right side of [Equation 10] and a second electric signal T2 based on the right side of [Equation 11]. That is, when the first electric signal T1 and the second electric signal T2 are written down focusing on the force Fz, it is as shown in the following [Equation 12].
[Equation 12]
T1 = -C11 + C31-C51 + C71
T2 = -C12 + C32-C52 + C72

ところで、図32に示すように、式T1の右辺を構成する容量素子C1n(n=1、3、5、7)(第1変位センサ)の静電容量値の変動量は、式T2の右辺を構成する容量素子C2n(n=1、3、5、7)(第2変位センサ)の静電容量値の変動量よりも大きい。このため、第3の実施の形態と同様に、例えばマイコン444の補正回路によって、第2電気信号T2に所定の補正係数kを乗じることによって、第1電気信号T1と第2電気信号T2の出力レベルを揃えることができる。 By the way, as shown in FIG. 32, the amount of change in the capacitance value of the capacitance element C1n (n = 1, 3, 5, 7) (first displacement sensor) constituting the right side of the equation T1 is the right side of the equation T2. It is larger than the fluctuation amount of the capacitance value of the capacitance element C2n (n = 1, 3, 5, 7) (second displacement sensor) constituting the above. Therefore, as in the third embodiment, the output of the first electric signal T1 and the second electric signal T2 is obtained by multiplying the second electric signal T2 by a predetermined correction coefficient k, for example, by the correction circuit of the microcomputer 444. You can align the levels.

そして、マイコン444に含まれる比較回路がこれら2つの電気信号T1、k・T2を比較する。この比較は、各信号T1、k・T2の差(例:T1−k・T2)、あるいは、各信号T1、k・T2の比(例:T1/(k・T2))に基づいて行われる。そして、2つの電気信号T1、k・T2の比較の結果、T1とk・T2との差または比が所定の範囲に含まれていれば、マイコン444の診断回路は、力覚センサ400cが正常に機能していると判定する。一方、T1とk・T2との差または比が所定の範囲に含まれていなければ、マイコン444の診断回路は、力覚センサ400cが正常に機能していない(故障している)と判定し、その判定結果を故障診断信号として出力する。このような検出回路440によれば、各容量素子を構成する電極の破損、短絡、異物の混入などの異常を単一の力覚センサ400cによって検知することができる。 Then, the comparison circuit included in the microcomputer 444 compares these two electric signals T1 and k · T2. This comparison is made based on the difference between the signals T1 and k · T2 (eg T1-k · T2) or the ratio of the signals T1 and k · T2 (eg T1 / (k · T2)). .. Then, as a result of comparing the two electric signals T1 and k / T2, if the difference or ratio between T1 and k / T2 is within a predetermined range, the diagnostic circuit of the microcomputer 444 has a normal force sensor 400c. Judge that it is functioning. On the other hand, if the difference or ratio between T1 and k / T2 is not included in the predetermined range, the diagnostic circuit of the microcomputer 444 determines that the force sensor 400c is not functioning normally (it is out of order). , The determination result is output as a failure diagnosis signal. According to such a detection circuit 440, abnormalities such as breakage, short circuit, and foreign matter contamination of the electrodes constituting each capacitive element can be detected by a single force sensor 400c.

もちろん、各容量素子C11〜C82の静電容量値の変動量をAD変換し、マイコン344によって各静電容量値を比較することによって、力覚センサ300cの故障を診断しても良い。 Of course, the failure of the force sensor 300c may be diagnosed by AD-converting the fluctuation amount of the capacitance values of the capacitance elements C11 to C82 and comparing the capacitance values with the microcomputer 344.

なお、以上の説明においては、力Fxに着目して第1電気信号T1及び第2電気信号T2を規定したが、この他の力Fy、Fz及びモーメントMx、My、Mzの1つまたは2つ以上に着目して第1電気信号T1及び第2電気信号T2を規定しても良い。 In the above description, the first electric signal T1 and the second electric signal T2 are defined by paying attention to the force Fx, but one or two of the other forces Fy, Fz and moments Mx, My, Mz. Focusing on the above, the first electric signal T1 and the second electric signal T2 may be defined.

以上のような本実施の形態によっても、第3の実施の形態と同様の効果を提供することができる。なお、以上の説明においては、特定の梁が片持ち梁に構成されていることを想定したが、もちろん、図27に示す両持ち梁の構造を有する力覚センサ300cを用いて、特定の容量素子のみを用いて当該力覚センサ300cに作用した力及びモーメントを計測しても良い。 The present embodiment as described above can also provide the same effect as that of the third embodiment. In the above description, it is assumed that the specific beam is configured as a cantilever, but of course, a specific capacitance is used by using the force sensor 300c having the structure of the double-sided beam shown in FIG. 27. The force and moment acting on the force sensor 300c may be measured using only the element.

< 4−2. 変形例による力覚センサ >
上述したように、力覚センサ400cは、Z軸まわりのモーメントMzを計測する際に、使用環境における温度変化の影響や同相ノイズの影響を受けやすいものであった。このため、当該モーメントMzを計測する際に、それらの影響を受けにくくできればより好ましい。ここでは、そのような力覚センサとして、6つの容量素子を備えた変形例について説明する。
<4-2. Force sensor by modification>
As described above, the force sensor 400c is susceptible to the influence of temperature changes and in-phase noise in the usage environment when measuring the moment Mz around the Z axis. Therefore, when measuring the moment Mz, it is more preferable if it can be less affected by them. Here, as such a force sensor, a modified example including six capacitive elements will be described.

図34は、第4の実施の形態の変形例による力覚センサ401cを示す概略上面図である。 FIG. 34 is a schematic top view showing the force sensor 401c according to the modified example of the fourth embodiment.

図34に示すように、力覚センサ401cは、第1及び第2梁421A、421Bが片持ち梁で構成されている点において、第3の実施の形態による力覚センサ300cと異なっている。具体的には、本変形例による力覚センサ401cの第1及び第2梁421A、421Bは、第4の実施の形態による力覚センサ400cの第1及び第2梁421A、421Bと同様であり、力覚センサ401cの第3及び第4梁421C、421Dは、図27に示す第3の実施の形態による力覚センサ300cの第3及び第4梁321C、321Dと同様である。したがって、力覚センサ401cでは、第1梁421Aに第1計測部位D1が、第2梁421Bに第3計測部位D3が、それぞれ規定されており、第3梁421Cに第5計測部位D5及び第6計測部位D6が、第4梁421Dに第7計測部位D7及び第8計測部位D8が、それぞれ規定されている。第5計測部位D5、第6計測部位D6、第7計測部位D7及び第8計測部位D8の配置は、第3の実施の形態による力覚センサ300cの対応する計測部位D51〜D8の配置と同一である。そして、これら6つの計測部位に容量素子C1n(n=1、3、5、6、7、8)(第1変位センサ)及び容量素子C2n(n=1、3、5、6、7、8)(第2変位センサ)が各1つずつ配置されている。各容量素子の構成は、第3の実施の形態と同じである。 As shown in FIG. 34, the force sensor 401c differs from the force sensor 300c according to the third embodiment in that the first and second beams 421A and 421B are composed of cantilever beams. Specifically, the first and second beams 421A and 421B of the force sensor 401c according to the present modification are the same as the first and second beams 421A and 421B of the force sensor 400c according to the fourth embodiment. The third and fourth beams 421C and 421D of the force sensor 401c are the same as those of the third and fourth beams 321C and 321D of the force sensor 300c according to the third embodiment shown in FIG. 27. Therefore, in the force sensor 401c, the first beam 421A defines the first measurement site D1, the second beam 421B defines the third measurement site D3, and the third beam 421C defines the fifth measurement site D5 and the third measurement site D3. The 6 measurement site D6 is defined, and the 7th measurement site D7 and the 8th measurement site D8 are defined on the 4th beam 421D, respectively. The arrangement of the fifth measurement part D5, the sixth measurement part D6, the seventh measurement part D7, and the eighth measurement part D8 is the same as the arrangement of the corresponding measurement parts D51 to D8 of the force sensor 300c according to the third embodiment. Is. Then, the capacitance element C1n (n = 1, 3, 5, 6, 7, 8) (first displacement sensor) and the capacitance element C2n (n = 1, 3, 5, 6, 7, 8) are attached to these six measurement sites. ) (Second displacement sensor) are arranged one by one. The configuration of each capacitive element is the same as that of the third embodiment.

図34には明確には図示されていないが、これらの6つの容量素子は、所定の回路によってマイコン444に接続されており、各容量素子の静電容量値が当該マイコン444に提供されるようになっている。そして、後述するように、マイコン444は、各容量素子の静電容量値の変動量に基づいて、力覚センサ401cに作用した力を検出するようになっている。 Although not clearly shown in FIG. 34, these six capacitive elements are connected to the microcomputer 444 by a predetermined circuit so that the capacitance value of each capacitive element is provided to the microcomputer 444. It has become. Then, as will be described later, the microcomputer 444 detects the force acting on the force sensor 401c based on the fluctuation amount of the capacitance value of each capacitance element.

力覚センサ401cのその他の構成については、第3の実施の形態と同様である。このため、第3の実施の形態と共通する構成要素に略同様の符号を付し、その詳細な説明を省略する。 Other configurations of the force sensor 401c are the same as those in the third embodiment. Therefore, substantially the same reference numerals are given to the components common to the third embodiment, and detailed description thereof will be omitted.

次に、本実施の形態による力覚センサ401cの作用について説明する。ここでは、第4の実施の形態と同様に、XYZ三次元座標系における各軸方向の力Fx、Fy、Fz及び各軸周りのモーメントMx、My、Mzのうち、Fz、Mx、My及びMzの4つの成分を検出する場合について説明を行う。 Next, the operation of the force sensor 401c according to the present embodiment will be described. Here, as in the fourth embodiment, among the forces Fx, Fy, Fz in each axial direction and the moments Mx, My, Mz around each axis in the XYZ three-dimensional coordinate system, Fz, Mx, My and Mz The case of detecting the four components of the above will be described.

本実施の形態による力覚センサ401cは、受力体460を介して受力部418、419に力またはモーメントが作用すると、6つの検出部D1、D3、D5〜D8には、それぞれ、第3の実施の形態による力覚センサ300cの対応する検出部D1、D3、D5〜D8と同じ変位が生じる。 In the force sensor 401c according to the present embodiment, when a force or a moment acts on the receiving units 418 and 419 via the receiving body 460, the six detection units D1, D3, and D5 to D8 are subjected to the third, respectively. The same displacement as the corresponding detection units D1, D3, D5 to D8 of the force sensor 300c according to the embodiment of the above is generated.

したがって、力覚センサ401cに力及びモーメントが作用すると、各容量素子の静電容量値は、図29のうち対応する容量素子と同様に変動する。このような静電容量値の変動に基づいて、マイコン444は、作用した力Fz及びモーメントMx、My、Mzを次の[式13]または[式14]により計測する。[式13]及び[式14]に示す4つの式のうち、Fz、Mx及びMyの式は、[式10]及び[式11]の対応する式とそれぞれ同一である。もちろん、[式13]及び[式14]において、力Fz及びモーメントMx、My、Mzの他軸感度は、いずれもゼロである。
[式13]
+Fz1=−C11+C31−C51+C71
+Mx1=−C11+C31+C51−C71
+My1=−C11−C31+C51+C71
+Mz1=−C11−C31+C61+C81
[式14]
+Fz2=−C12+C32−C52+C72
+Mx2=−C12+C32+C52−C72
+My2=−C12−C32+C52+C72
+Mz2=−C12−C32+C62+C82
Therefore, when a force and a moment act on the force sensor 401c, the capacitance value of each capacitive element fluctuates in the same manner as the corresponding capacitive element in FIG. 29. Based on such a fluctuation of the capacitance value, the microcomputer 444 measures the acting force Fz and the moments Mx, My, and Mz by the following [Equation 13] or [Equation 14]. Of the four equations shown in [Equation 13] and [Equation 14], the equations of Fz, Mx and My are the same as the corresponding equations of [Equation 10] and [Equation 11], respectively. Of course, in [Equation 13] and [Equation 14], the forces Fz and the other axis sensitivities of the moments Mx, My, and Mz are all zero.
[Equation 13]
+ Fz1 = -C11 + C31-C51 + C71
+ Mx1 = -C11 + C31 + C51-C71
+ My1 = -C11-C31 + C51 + C71
+ Mz1 = -C11-C31 + C61 + C81
[Equation 14]
+ Fz2 = -C12 + C32-C52 + C72
+ Mx2 = -C12 + C32 + C52-C72
+ My2 = -C12-C32 + C52 + C72
+ Mz2 = -C12-C32 + C62 + C82

以上のような力覚センサ401cによっても、第3の実施の形態と同様の効果が提供され得る。更に、力覚センサ401cによれば、Z軸まわりのモーメントMzを差分によって演算することができるため、力覚センサ401cの使用環境における温度変化や同相ノイズの影響を排除して、高精度に当該モーメントMzを計測することができる。 The force sensor 401c as described above can also provide the same effect as that of the third embodiment. Further, according to the force sensor 401c, the moment Mz around the Z axis can be calculated by the difference, so that the influence of the temperature change and the common mode noise in the usage environment of the force sensor 401c is eliminated and the measurement is performed with high accuracy. The moment Mz can be measured.

なお、力覚センサ401cにおける故障診断の方法は、4−1.で説明した第4の実施の形態による力覚センサ400cと同様であるため、ここでは、その説明は省略する。 The method of failure diagnosis in the force sensor 401c is described in 4-1. Since it is the same as the force sensor 400c according to the fourth embodiment described in the above, the description thereof will be omitted here.

< 4−3. 更なる変形例による力覚センサ >
(4−3−1.変形例1)
力Fz及びモーメントMx、My、Mzを検出するための力覚センサとして、図31では、図27に示す力覚センサ300cから、8つの容量素子C21、C22、C41、C42、C61、C62、C81、C82を削除したものを示したが、このような態様には限定されない。他の例による力覚センサ(不図示)としては、図27に示す力覚センサ300cから、8つの容量素子C11、C12、C41、C42、C51、C52、C81、C82を削除したものが考えられる。すなわち、この力覚センサは、8つの容量素子C21、C22、C31、C32、C61、C62、C71、C72を有している。
<4-3. Force sensor by further modification>
(4-3-1. Modification 1)
As a force sensor for detecting the force Fz and the moments Mx, My, Mz, in FIG. 31, from the force sensor 300c shown in FIG. 27, eight capacitive elements C21, C22, C41, C42, C61, C62, C81. , C82 is deleted, but the present invention is not limited to such an embodiment. As a force sensor (not shown) according to another example, it is conceivable that eight capacitive elements C11, C12, C41, C42, C51, C52, C81, and C82 are deleted from the force sensor 300c shown in FIG. 27. .. That is, this force sensor has eight capacitive elements C21, C22, C31, C32, C61, C62, C71, and C72.

この力覚センサに対し、力及びモーメントが作用したときの各容量素子の増減は、図29に示す対応する容量素子の増減と同一である。したがって、この力覚センサの検出回路440のマイコン444は、作用した力Fz及びモーメントMx、My、Mzを次の[式15]及び[式16]により計測する。[式15]及び[式16]は、それぞれ、[式6]及び[式7]のFz、Mx、My及びMzの式から、対応する容量素子のみを抜き出したものである。
[式15]
+Fz1=C21+C31+C61+C71
+Mx1=C21+C31−C61−C71
+My1=C21−C31−C61+C71
+Mz1=C21−C31+C61−C71
[式16]
+Fz2=C22+C32+C62+C72
+Mx2=C22+C32−C62−C72
+My2=C22−C32−C62+C72
+Mz2=C22−C32+C62−C72
The increase / decrease of each capacitance element when a force and a moment are applied to the force sensor is the same as the increase / decrease of the corresponding capacitance element shown in FIG. Therefore, the microcomputer 444 of the detection circuit 440 of the force sensor measures the acting force Fz and the moments Mx, My, and Mz by the following [Equation 15] and [Equation 16]. [Equation 15] and [Equation 16] are obtained by extracting only the corresponding capacitive elements from the equations of Fz, Mx, My and Mz of [Equation 6] and [Equation 7], respectively.
[Equation 15]
+ Fz1 = C21 + C31 + C61 + C71
+ Mx1 = C21 + C31-C61-C71
+ My1 = C21-C31-C61 + C71
+ Mz1 = C21-C31 + C61-C71
[Equation 16]
+ Fz2 = C22 + C32 + C62 + C72
+ Mx2 = C22 + C32-C62-C72
+ My2 = C22-C32-C62 + C72
+ Mz2 = C22-C32 + C62-C72

図29に示す、対応する容量素子の静電容量値の増減と[式15]または[式16]とに基づき、力Fz及びモーメントMx、My、Mzの他軸感度を求めると、図33と同一になる。したがって、力Fz及びモーメントMx、My、Mzの他軸感度は、ゼロである。但し、[式15]及び[式16]によれば、Z軸方向の力Fzは、静電容量値の和によって求められる。このため、力Fzについては、力覚センサの使用環境における温度変化や同相ノイズの影響を受けやすい点に注意が必要である。 Based on the increase / decrease in the capacitance value of the corresponding capacitive element and [Equation 15] or [Equation 16] shown in FIG. Be the same. Therefore, the other axis sensitivity of the force Fz and the moments Mx, My, and Mz is zero. However, according to [Equation 15] and [Equation 16], the force Fz in the Z-axis direction is obtained by the sum of the capacitance values. Therefore, it should be noted that the force Fz is easily affected by temperature changes and in-phase noise in the usage environment of the force sensor.

(4−3−2.変形例2)
あるいは、力Fz及びモーメントMx、My、Mzを検出するための力覚センサとして図27に示す力覚センサ300cから、8つの容量素子C21、C22、C31、C32、C61、C62、C71、C72を削除したものも考えられる。すなわち、この力覚センサは、8つの容量素子C11、C12、C41、C42、C51、C52、C81、C82を有している。
(4-3-2. Modification 2)
Alternatively, eight capacitive elements C21, C22, C31, C32, C61, C62, C71, and C72 are added from the force sensor 300c shown in FIG. 27 as a force sensor for detecting the force Fz and the moments Mx, My, and Mz. It may have been deleted. That is, this force sensor has eight capacitive elements C11, C12, C41, C42, C51, C52, C81, and C82.

この力覚センサに対し、力及びモーメントが作用したときの各容量素子の増減は、図29に示す対応する容量素子の増減と同一である。したがって、この力覚センサの検出回路440のマイコン444は、作用した力Fz及びモーメントMx、My、Mzを次の[式17]及び[式18]により計測する。[式17]及び[式18]は、それぞれ、[式6]及び[式7]のFz、Mx、My及びMzの式から、対応する容量素子のみを抜き出したものである。
[式17]
+Fz1=−C11−C41−C51−C81
+Mx1=−C11−C41+C51+C81
+My1=−C11+C41+C51−C81
+Mz1=−C11+C41−C51+C81
[式18]
+Fz2=−C12−C42−C52−C82
+Mx2=−C12−C42+C52+C82
+My2=−C12+C42+C52−C82
+Mz2=−C12+C42−C52+C82
The increase / decrease of each capacitive element when a force and a moment are applied to the force sensor is the same as the increase / decrease of the corresponding capacitive element shown in FIG. Therefore, the microcomputer 444 of the detection circuit 440 of the force sensor measures the applied force Fz and the moments Mx, My, and Mz by the following [Equation 17] and [Equation 18]. [Equation 17] and [Equation 18] are obtained by extracting only the corresponding capacitive elements from the equations of Fz, Mx, My and Mz of [Equation 6] and [Equation 7], respectively.
[Equation 17]
+ Fz1 = -C11-C41-C51-C81
+ Mx1 = -C11-C41 + C51 + C81
+ My1 = -C11 + C41 + C51-C81
+ Mz1 = -C11 + C41-C51 + C81
[Equation 18]
+ Fz2 = -C12-C42-C52-C82
+ Mx2 = -C12-C42 + C52 + C82
+ My2 = -C12 + C42 + C52-C82
+ Mz2 = -C12 + C42-C52 + C82

図29に示す、対応する容量素子の静電容量値の増減と[式17]または[式18]とに基づき、力Fz及びモーメントMx、My、Mzの他軸感度を求めると、図33と同一になる。したがって、力Fz及びモーメントMx、My、Mzの他軸感度は、ゼロである。但し、[式17]及び[式18]によれば、Z軸方向の力Fzは、静電容量値の和によって求められる。このため、力Fzについては、力覚センサの使用環境における温度変化や同相ノイズの影響を受けやすい点に注意が必要である。 Based on the increase / decrease in the capacitance value of the corresponding capacitive element and [Equation 17] or [Equation 18] shown in FIG. Be the same. Therefore, the other axis sensitivity of the force Fz and the moments Mx, My, and Mz is zero. However, according to [Equation 17] and [Equation 18], the force Fz in the Z-axis direction is obtained by the sum of the capacitance values. Therefore, it should be noted that the force Fz is easily affected by temperature changes and in-phase noise in the usage environment of the force sensor.

なお、S/Nの観点から、相対的に静電容量値の変動が大きい容量素子に基づく式を用いて、すなわち変形例1においては[式15]を用いて、変形例2においては[式17]を用いて、作用した力及びモーメントを計測するか、あるいは、各変形例において[式8]のFz3、Mx3、My3及びMz3に対応する合算電気信号を算出し、この合算電気信号によって、作用した力及びモーメントを計測することが好ましい。 From the viewpoint of S / N, an equation based on a capacitive element in which the capacitance value fluctuates relatively large is used, that is, [Equation 15] is used in the modified example 1, and [Equation 15] is used in the modified example 2. 17] is used to measure the acting force and moment, or in each modification, a total electric signal corresponding to Fz3, Mx3, My3 and Mz3 of [Equation 8] is calculated, and the total electric signal is used to calculate the total electric signal. It is preferable to measure the acting force and moment.

以上に示す変形例1及び2のいずれの場合も、故障診断の方法は、第4の実施の形態による力覚センサ400cと同様である。このため、ここではその詳細な説明については省略する。 In any of the above-described modifications 1 and 2, the method of failure diagnosis is the same as that of the force sensor 400c according to the fourth embodiment. Therefore, the detailed description thereof will be omitted here.

<<< §5. 本発明の第5の実施の形態による力覚センサ及びその変形例 >>>
< 5−1. 本発明の第5の実施の形態による力覚センサ >
§4では、第4の実施の形態及びその変形例として、特にモーメントMx、My、Mzを重点的に計測するのに適した力覚センサについて説明を行った。ここでは、力Fx、Fy、Fzを重点的に計測するのに適した力覚センサについて説明する。
<<< §5. Force sensor according to the fifth embodiment of the present invention and its modification >>>
<5-1. Force sensor according to the fifth embodiment of the present invention>
In §4, as a fourth embodiment and a modification thereof, a force sensor suitable for intensively measuring moments Mx, My, and Mz has been described. Here, a force sensor suitable for intensively measuring forces Fx, Fy, and Fz will be described.

図35は、本発明の第5の実施の形態による力覚センサ500cを示す概略上面図である。図5に示すように、力覚センサ500cは、第4の実施の形態と同様に8つの容量素子を有しているが、それらの配置が第4の実施の形態とは異なっている。具体的には、力覚センサ500cの各梁521A〜521Dは、力覚センサ300cの各梁321A〜321Dのうち、固定部316、317側の部位をそれぞれ削除した片持ち梁の構造を有している。したがって、力覚センサ500cでは、各梁521A〜521Dに各1つの計測部位D1、D4、D5、D8が規定されている。そして、これら4つの計測部位D1、D4、D5、D8に各2つの容量素子C11、C12、C41、C42、C51、C52、C81、C82が配置されている。各容量素子の構成は、第2の実施の形態と同じである。 FIG. 35 is a schematic top view showing the force sensor 500c according to the fifth embodiment of the present invention. As shown in FIG. 5, the force sensor 500c has eight capacitive elements as in the fourth embodiment, but their arrangement is different from that of the fourth embodiment. Specifically, the beams 521A to 521D of the force sensor 500c have a cantilever structure in which the portions on the fixed portions 316 and 317 of the beams 321A to 321D of the force sensor 300c are deleted. ing. Therefore, in the force sensor 500c, one measurement site D1, D4, D5, D8 is defined for each of the beams 521A to 521D. Then, two capacitive elements C11, C12, C41, C42, C51, C52, C81, and C82 are arranged at each of the four measurement sites D1, D4, D5, and D8. The configuration of each capacitive element is the same as that of the second embodiment.

これらの8つの容量素子は、図31には図示されていないが、所定の回路によって検出回路540のマイコン544に接続されており、各容量素子の静電容量値が当該マイコン544に提供されるようになっている。そして、後述するように、マイコン544は、各容量素子の静電容量値の変動量に基づいて、力覚センサ500cに作用した力を検出するようになっている。 Although these eight capacitive elements are not shown in FIG. 31, they are connected to the microcomputer 544 of the detection circuit 540 by a predetermined circuit, and the capacitance value of each capacitive element is provided to the microcomputer 544. It has become like. Then, as will be described later, the microcomputer 544 detects the force acting on the force sensor 500c based on the fluctuation amount of the capacitance value of each capacitance element.

力覚センサ500cのその他の構成については、第3及び第4の実施の形態と同様である。このため、第3及び第4の実施の形態と共通する構成要素に略同様の符号を付し、その詳細な説明を省略する。 Other configurations of the force sensor 500c are the same as those in the third and fourth embodiments. Therefore, substantially the same reference numerals are given to the components common to the third and fourth embodiments, and detailed description thereof will be omitted.

次に、本実施の形態による力覚センサ500cの作用について説明する。ここでは、XYZ三次元座標系における各軸方向の力Fx、Fy、Fz及び各軸周りのモーメントMx、My、Mzのうち、Fx、Fy、Fz及びMzの4つの成分を検出する場合について説明を行う。なお、これら4つの成分は、第3の実施の形態による力覚センサ300cが検出可能な4つの成分でもある。 Next, the operation of the force sensor 500c according to the present embodiment will be described. Here, a case of detecting four components of Fx, Fy, Fz, and Mz among the forces Fx, Fy, Fz in each axial direction and the moments Mx, My, and Mz around each axis in the XYZ three-dimensional coordinate system will be described. I do. It should be noted that these four components are also four components that can be detected by the force sensor 300c according to the third embodiment.

図36は、図35に示す力覚センサ500cに力及びモーメントの4つの成分Fx、Fy、Fz、Mzが作用したときの、各容量素子の静電容量値の変動を一覧で示す図表である。上述したように、本実施の形態による力覚センサ500cは、梁521A〜521Dが片持ち梁で構成されている点を除いて、第3の実施の形態による力覚センサ300cと同様の構造を有している。したがって、受力体560を介して受力部518、519に力またはモーメントが作用すると、各梁521A〜521Dの各検出部D1、D4、D5、D8には、それぞれ、第3の実施の形態による力覚センサ300cにおける対応する検出部と同じ変位が生じる。 FIG. 36 is a chart showing a list of fluctuations in the capacitance value of each capacitive element when the four components Fx, Fy, Fz, and Mz of force and moment act on the force sensor 500c shown in FIG. 35. .. As described above, the force sensor 500c according to the present embodiment has the same structure as the force sensor 300c according to the third embodiment, except that the beams 521A to 521D are formed of cantilever beams. Have. Therefore, when a force or a moment acts on the receiving portions 518 and 519 via the receiving body 560, the detection portions D1, D4, D5, and D8 of the beams 521A to 521D have the third embodiment, respectively. The same displacement as the corresponding detection unit in the force sensor 300c is generated.

したがって、力覚センサ500cに力及びモーメントが作用したときの各容量素子の増減は、図29に示す対応する容量素子の増減と同一である。図29と同様に、図中の「+」の記号は、静電容量値が増大することを示しており、「−」の記号は、静電容量値が減少することを示している。 Therefore, the increase / decrease of each capacitive element when a force and a moment act on the force sensor 500c is the same as the increase / decrease of the corresponding capacitive element shown in FIG. 29. Similar to FIG. 29, the “+” symbol in the figure indicates that the capacitance value increases, and the “−” symbol indicates that the capacitance value decreases.

このような静電容量値の変動に基づいて、マイコン544は、作用した力Fx、Fy、Fz及びモーメントMzを次の[式19]または[式20]により計測する。[式19]及び[式20]は、[式6]及び[式7]のFz、Mx、My及びMzの式から、対応する容量素子のみを抜き出したものである。
[式19]
+Fx1=C11−C41−C51+C81
+Fy1=C11+C41−C51−C81
+Fz1=−C11−C41−C51−C81
+Mz1=−C11+C41−C51+C81
[式20]
+Fx2=C12−C42−C52+C82
+Fy2=C12+C42−C52−C82
+Fz2=−C12−C42−C52−C82
+Mz2=−C12+C42−C52+C82
Based on such a fluctuation of the capacitance value, the microcomputer 544 measures the acting force Fx, Fy, Fz and the moment Mz by the following [Equation 19] or [Equation 20]. [Equation 19] and [Equation 20] are obtained by extracting only the corresponding capacitive elements from the equations of Fz, Mx, My and Mz of [Equation 6] and [Equation 7].
[Equation 19]
+ Fx1 = C11-C41-C51 + C81
+ Fy1 = C11 + C41-C51-C81
+ Fz1 = -C11-C41-C51-C81
+ Mz1 = -C11 + C41-C51 + C81
[Equation 20]
+ Fx2 = C12-C42-C52 + C82
+ Fy2 = C12 + C42-C52-C82
+ Fz2 = -C12-C42-C52-C82
+ Mz2 = -C12 + C42-C52 + C82

図36に示す、対応する容量素子の静電容量値の増減と[式19]または[式20]とに基づき、力Fx、Fy、Fz及びモーメントMzの他軸感度を求めると、いずれもゼロである。他軸感度の算出方法は、他の実施の形態と同様である。但し、[式19]及び[式20]によれば、Z軸方向の力Fzは、静電容量値の和によって求められる。このため、力Fzについては、力覚センサ500cの使用環境における温度変化や同相ノイズの影響を受けやすい点に注意が必要である。 Based on the increase / decrease in the capacitance value of the corresponding capacitive element and [Equation 19] or [Equation 20] shown in FIG. 36, the other axis sensitivities of the forces Fx, Fy, Fz and the moment Mz are all zero. Is. The method for calculating the sensitivity of the other axis is the same as that of the other embodiments. However, according to [Equation 19] and [Equation 20], the force Fz in the Z-axis direction is obtained by the sum of the capacitance values. Therefore, it should be noted that the force Fz is easily affected by temperature changes and in-phase noise in the usage environment of the force sensor 500c.

本実施の形態においても、S/Nの観点から、相対的に静電容量値の変動が大きい容量素子に基づく[式19]によって作用した力及びモーメントを計測するか、あるいは、[式19]及び[式20]に基づき、[式8]のFx3、Fy3、Fz3及びMz3に対応する合算電気信号を算出し、この合算電気信号によって、作用した力及びモーメントを計測することが好ましい。 Also in the present embodiment, from the viewpoint of S / N, the force and the moment acted by [Equation 19] based on the capacitive element in which the capacitance value fluctuates relatively large are measured, or [Equation 19] And, based on [Equation 20], it is preferable to calculate the total electric signal corresponding to Fx3, Fy3, Fz3 and Mz3 of [Equation 8], and measure the acting force and moment by this total electric signal.

以上のような本実施の形態における故障診断の方法は、第4の実施の形態による力覚センサ400cと同様である。このため、ここではその詳細な説明については省略する。 The method of failure diagnosis in the present embodiment as described above is the same as that of the force sensor 400c according to the fourth embodiment. Therefore, the detailed description thereof will be omitted here.

このような力覚センサ500cによっても、第3の実施の形態と同様の効果を提供することができる。とりわけ、本実施の形態では、各軸方向の力を検出することが可能であり、且つ、故障診断が可能な、力覚センサ500cを提供することができる。 Such a force sensor 500c can also provide the same effect as that of the third embodiment. In particular, in the present embodiment, it is possible to provide a force sensor 500c capable of detecting a force in each axial direction and diagnosing a failure.

< 5−2. 変形例による力覚センサ >
上述したように、力覚センサ500cは、Z軸方向の力Fzを計測する際に、使用環境における温度変化の影響や同相ノイズの影響を受けやすいものであった。このため、当該力Fzを計測する際に、それらの影響を受けにくくできればより好ましい。ここでは、そのような力覚センサ501cについて説明する。
<5-2. Force sensor by modification>
As described above, the force sensor 500c is susceptible to the influence of temperature changes and in-phase noise in the usage environment when measuring the force Fz in the Z-axis direction. Therefore, when measuring the force Fz, it is more preferable if it can be less affected by them. Here, such a force sensor 501c will be described.

図37は、第5の実施の形態の変形例による力覚センサ501cを示す概略上面図である。図37に示すように、力覚センサ501cの基本構造501及び容量素子の配置は、Y座標が正(図37の上半分)の部分が図35の力覚センサ500cと同じであり、Y座標が負(図37の下半分)の部分が図27に示す力覚センサ300cと同じである。図37には明確には図示されていないが、各容量素子は、所定の回路によってマイコン544に接続されており、各容量素子の静電容量値がマイコン544に提供されるようになっている。そして、後述するように、マイコン544は、各容量素子の静電容量値の変動量に基づいて、力覚センサ501cに作用した力を検出するようになっている。 FIG. 37 is a schematic top view showing the force sensor 501c according to the modified example of the fifth embodiment. As shown in FIG. 37, the arrangement of the basic structure 501 and the capacitive element of the force sensor 501c is the same as that of the force sensor 500c in FIG. 35 in the portion where the Y coordinate is positive (upper half of FIG. 37), and the Y coordinate. The negative part (lower half of FIG. 37) is the same as the force sensor 300c shown in FIG. 27. Although not clearly shown in FIG. 37, each capacitive element is connected to the microcomputer 544 by a predetermined circuit, and the capacitance value of each capacitive element is provided to the microcomputer 544. .. Then, as will be described later, the microcomputer 544 detects the force acting on the force sensor 501c based on the fluctuation amount of the capacitance value of each capacitance element.

力覚センサ501cのその他の構成については、第3の実施の形態と同様である。このため、第3の実施の形態と共通する構成要素に略同様の符号を付し、その詳細な説明を省略する。 Other configurations of the force sensor 501c are the same as in the third embodiment. Therefore, substantially the same reference numerals are given to the components common to the third embodiment, and detailed description thereof will be omitted.

力覚センサ501cに力及びモーメントが作用したときの各容量素子の増減は、図29に示す対応する容量素子の増減と同一である。このような静電容量値の変動に基づいて、マイコン544は、作用した力Fx、Fy、Fz及びモーメントMzを次の[式21]または[式22]により計測する。[式21]及び[式21]は、[式6]及び[式7]のFx、Fy、Fz及びMzの式から、対応する容量素子のみを抜き出したものである。なお、[式21]及び[式22]に示す4つの式のうち、Fx、Fy及びMzの式は、[式19]及び「式20]の対応する式とそれぞれ同一である。もちろん、[式21]及び[式21]において、力Fx、Fy、Fz及びモーメントMzの他軸感度は、いずれもゼロである。
[式21]
+Fx1=C11−C41−C51+C81
+Fy1=C11+C41−C51−C81
+Fz1=−C11−C41+C61+C71
+Mz1=−C11+C41−C51+C81
[式22]
+Fx2=C12−C42−C52+C82
+Fy2=C12+C42−C52−C82
+Fz2=−C12−C42+C62+C72
+Mz2=−C12+C42−C52+C82
The increase / decrease of each capacitive element when a force or moment acts on the force sensor 501c is the same as the increase / decrease of the corresponding capacitive element shown in FIG. 29. Based on such a fluctuation of the capacitance value, the microcomputer 544 measures the acting force Fx, Fy, Fz and the moment Mz by the following [Equation 21] or [Equation 22]. [Equation 21] and [Equation 21] are obtained by extracting only the corresponding capacitive elements from the Fx, Fy, Fz and Mz equations of [Equation 6] and [Equation 7]. Of the four equations shown in [Equation 21] and [Equation 22], the equations of Fx, Fy and Mz are the same as the corresponding equations of [Equation 19] and "Equation 20", respectively. In Equation 21] and [Equation 21], the other axis sensitivities of the forces Fx, Fy, Fz and the moment Mz are all zero.
[Equation 21]
+ Fx1 = C11-C41-C51 + C81
+ Fy1 = C11 + C41-C51-C81
+ Fz1 = -C11-C41 + C61 + C71
+ Mz1 = -C11 + C41-C51 + C81
[Equation 22]
+ Fx2 = C12-C42-C52 + C82
+ Fy2 = C12 + C42-C52-C82
+ Fz2 = -C12-C42 + C62 + C72
+ Mz2 = -C12 + C42-C52 + C82

本実施の形態においても、S/Nの観点から、相対的に静電容量値の変動が大きい容量素子に基づく[式21]によって作用した力及びモーメントを計測するか、あるいは、[式21]及び[式22]に基づき、[式8]のFx3、Fy3、Fz3及びMz3に対応する合算電気信号を算出し、この合算電気信号によって作用した力及びモーメントを計測することが、好ましい。 Also in the present embodiment, from the viewpoint of S / N, the force and the moment acted by [Equation 21] based on the capacitive element in which the capacitance value fluctuates relatively large are measured, or [Equation 21] It is preferable to calculate the total electric signal corresponding to Fx3, Fy3, Fz3 and Mz3 of [Equation 8] based on [Equation 22] and measure the force and the moment acted by the total electric signal.

本変形例における故障診断の方法は、第5の実施の形態による力覚センサ500cと同様である。このため、ここではその詳細な説明については省略する。 The method of failure diagnosis in this modified example is the same as that of the force sensor 500c according to the fifth embodiment. Therefore, the detailed description thereof will be omitted here.

このような力覚センサ501cによっても、第5の実施の形態による力覚センサ500cと同様の効果を提供することができる。とりわけ、本実施の形態では、4つの成分の全てを差分によって演算することができるため、力覚センサ501cの使用環境における温度変化や同相ノイズの影響を排除して、高精度に当該モーメントMzを計測することができる。 Such a force sensor 501c can also provide the same effect as the force sensor 500c according to the fifth embodiment. In particular, in the present embodiment, since all four components can be calculated by the difference, the influence of the temperature change and the in-phase noise in the usage environment of the force sensor 501c is eliminated, and the moment Mz is calculated with high accuracy. Can be measured.

以上から、§4及び§5で説明したように、図1に示す力覚センサ100cを4つ、閉ループ状に並べることで、力の4成分(Fz、Mx、My、Mzの組、またはFx、Fy、Fz、Mzの組)を検出することができる。もちろん、これらの4成分のうち任意の成分のみを検出しても良い。 From the above, as described in §4 and §5, by arranging four force sensor 100c shown in FIG. 1 in a closed loop, the four components of force (Fz, Mx, My, Mz set, or Fx , Fy, Fz, Mz set) can be detected. Of course, only any of these four components may be detected.

なお、§4及び§5で説明した各実施の形態及びそれらの変形例による各力覚センサ400c、401c、500c、501cは、特定の梁を片持ち梁の構造に置換したモデルとして説明を行った。しかしながら、このような例には限られず、図27に示す両持ち梁の構造を維持したままで、各力覚センサに採用されている特定の容量素子のみに着目することにより、作用した力及びモーメントを計測しても良い。 The force sensors 400c, 401c, 500c, and 501c according to the embodiments described in §4 and §5 and their modifications are described as models in which a specific beam is replaced with a cantilever structure. rice field. However, the present invention is not limited to such an example, and by focusing only on the specific capacitive element adopted in each force sensor while maintaining the structure of the double-sided beam shown in FIG. The moment may be measured.

<<< §6. 本発明の第6の実施の形態による力覚センサ >>>
< 6−1. 力覚センサの構成 >
§1で説明したように、図7の力覚センサ100cは、変形体10の金属疲労によって当該力覚センサ100cが故障してしまうことを検知することができなかった。このため、図7に示す力覚センサ100cを4つ、閉ループ状に連結して構成された§3の力覚センサ300cについても、同様のことが言える。
<<< §6. Force sensor according to the sixth embodiment of the present invention >>>
<6-1. Force sensor configuration >
As described in §1, the force sensor 100c of FIG. 7 could not detect that the force sensor 100c would fail due to metal fatigue of the deformed body 10. Therefore, the same can be said for the force sensor 300c of §3, which is configured by connecting four force sensors 100c shown in FIG. 7 in a closed loop shape.

一方、§2の力覚センサ200cは、変形体220に金属疲労が生じているか否かを検知することができるため、この力覚センサ200cを4つ、閉ループ状に連結して新たな力覚センサを構成すれば、力及びモーメントの4成分の検出と、金属疲労による力覚センサの故障とを、検知することができる。ここでは、第6の実施の形態として、そのような力覚センサ600cについて、図38及び図39を参照して説明する。 On the other hand, since the force sensor 200c of §2 can detect whether or not metal fatigue has occurred in the deformed body 220, four force sense sensors 200c are connected in a closed loop to form a new force sense. If the sensor is configured, it is possible to detect the detection of the four components of force and moment and the failure of the force sensor due to metal fatigue. Here, as a sixth embodiment, such a force sensor 600c will be described with reference to FIGS. 38 and 39.

図38は、本発明の第6の実施の形態による力覚センサ600cを示す概略上面図であり、図39は、XYZ三次元座標系における各軸正方向の力+Fx、+Fy、+Fz及び各軸正まわりのモーメント+Mx、+My、+Mzが作用したときの、図38に示す力覚センサ600cの各容量素子C11〜C82の静電容量値の増減を一覧で示す図表である。 FIG. 38 is a schematic top view showing the force sensor 600c according to the sixth embodiment of the present invention, and FIG. 39 is a force + Fx, + Fy, + Fz and each axis in the positive direction of each axis in the XYZ three-dimensional coordinate system. It is a chart which shows the increase / decrease of the capacitance value of each capacitance element C11-C82 of the force sensor 600c shown in FIG. 38 when the positive moment + Mx, + My, + Mz act.

図38に示すように、力覚センサ600cは、閉ループ状の変形体であって、2つの受力部618、619と、閉ループ状の経路に沿って2つの受力部618、619と交互に配置された2つの固定部616、617と、閉ループ状の経路に沿って隣接する受力部618、619及び固定部616、617を接続し、受力部618、619に作用した力ないしモーメントにより弾性変形を生じる4つの変形要素610A〜610Dと、を有する変形体610を備えている。 As shown in FIG. 38, the force sensor 600c is a closed-loop deformed body, and alternately has two receiving portions 618 and 619 and two receiving portions 618 and 619 along a closed-loop path. The two fixed portions 616 and 617 arranged are connected to the adjacent receiving portions 618 and 619 and the fixed portions 616 and 617 along a closed loop path, and the force or moment acting on the receiving portions 618 and 619 causes the two fixed portions 616 and 617 to be connected to each other. It includes a deformed body 610 having four deforming elements 610A to 610D that cause elastic deformation.

4つの変形要素610A〜610Dは、それぞれ、長手方向(図38における紙面に垂直な方向)を有し、受力部618、619と固定部616、617との間に、受力部618、619から固定部616、617に向かって順次配置された第1傾動部613Aa〜613Da及び第2傾動部613Ab〜613Dbと、第1傾動部613Aa〜613Daと第2傾動部613Ab〜613Dbとの間に配置された力伝達部616A〜616Dと、を有している。そして、第1傾動部613Aa〜613Daと対応する受力部618、619とが、第1−1変形部611Aa〜611Daによって接続され、力伝達部616A〜616Dと第1傾動部613Aa〜613Daとが第1−2変形部612Aa〜612Daによって接続されている。更に、力伝達部616A〜616Dと第2傾動部613Ab〜613Dbとを接続する第2−1変形部611Ab〜611Dbによって接続され、第2傾動部613Ab〜613Dbと対応する固定部616、617とが第2−2変形部612Ab〜612Dbによって接続されている。 Each of the four deformation elements 610A to 610D has a longitudinal direction (direction perpendicular to the paper surface in FIG. 38), and between the receiving portions 618 and 619 and the fixing portions 616 and 617, the receiving portions 618 and 619. The first tilting portions 613Aa to 613Da and the second tilting portions 613Ab to 613Db, which are sequentially arranged from the fixed portions 616 and 617, are arranged between the first tilting portions 613Aa to 613Da and the second tilting portions 613Ab to 613Db. It has the force transmission units 616A to 616D. Then, the first tilting portions 613Aa to 613Da and the corresponding force receiving portions 618 and 619 are connected by the 1-1 deformed portions 611Aa to 611Da, and the force transmitting portions 616A to 616D and the first tilting portions 613Aa to 613Da are connected to each other. It is connected by the first and second deformed portions 612Aa to 612Da. Further, the force transmitting portions 616A to 616D and the second tilting portions 613Ab to 613Db are connected by the second deformed portions 611Ab to 611Db, and the second tilting portions 613Ab to 613Db and the corresponding fixing portions 616 and 617 are connected to each other. It is connected by the second 2-2 deformation portions 612Ab to 612Db.

各変形部は、傾動部613Aa〜613Da、613Ab〜613Dbの長手方向と交差する方向(図38における紙面の面内方向)に延在している。そして、図10に示す力覚センサ200cと同様に、第1−1変形部611Aa〜611Daと第1傾動部613Aa〜613Daとの接続部位と、第1−2変形部612Aa〜612Daと第1傾動部613Aa〜613Daとの接続部位とは、当該第1傾動部613Aa〜613Daの長手方向において位置が異なっている。同様に、第2−1変形部611Ab〜611Dbと第2傾動部613Ab〜613Dbとの接続部位と、第2−2変形部612Ab〜612Dbと第2傾動部613Ab〜613Dbとの接続部位とは、当該第2傾動部613Ab〜613Dbの長手方向において位置が異なっている。 Each deformed portion extends in a direction intersecting the longitudinal direction of the tilting portions 613Aa to 613Da and 613Ab to 613Db (in-plane direction of the paper surface in FIG. 38). Then, similarly to the force sensor 200c shown in FIG. 10, the connection portion between the 1-1 deformed portions 611Aa to 611Da and the first tilting portions 613Aa to 613Da, and the 1-2 deformed portions 612Aa to 612Da and the first tilting portion The positions of the connection portions with the portions 613Aa to 613Da are different in the longitudinal direction of the first tilting portions 613Aa to 613Da. Similarly, the connection portion between the 2-1 deformed portions 611Ab to 611Db and the second tilting portion 613Ab to 613Db, and the connecting portion between the 2-2 deformed portions 612Ab to 612Db and the second tilting portion 613Ab to 613Db are The positions of the second tilting portions 613Ab to 613Db are different in the longitudinal direction.

更に、変形体610は、第1−1変形部611Aa〜611Da及び第1−2変形部612Aa〜612Daのバネ定数と、第2−1変形部611Ab〜611Db及び第2−2変形部612Ab〜612Dbのバネ定数とが、異なっている。具体的には、本実施の形態では、第1−1変形部611Aa〜611Da及び第1−2変形部612Aa〜612Daのバネ定数が、第2−1変形部611Ab〜611Db及び第2−2変形部612Ab〜612Dbのバネ定数よりも、小さい。 Further, the deformed body 610 includes the spring constants of the 1-1 deformed portions 611Aa to 611Da and the 1-2 deformed portions 612Aa to 612Da, and the 2-1 deformed portions 611Ab to 611Db and the 2-2 deformed portions 612Ab to 612Db. The spring constant of is different. Specifically, in the present embodiment, the spring constants of the 1-1 deformed portions 611Aa to 611Da and the 1-2 deformed portions 612Aa to 612Da are changed to the 2-1 deformed portions 611Ab to 611Db and the 2-2 deformed portions. It is smaller than the spring constant of parts 612Ab to 612Db.

図38に示すように、各変形要素610A〜610Dには、当該変形要素610A〜610Dに生じる弾性変形により変位を生じる変位体620Aa〜620Da及び620Ab〜620Dbが接続されている。本実施の形態では、各傾動部に変位体が接続されている。具体的には、変位体は、各固定部616、617から離間し各第1傾動部613Aa〜613Dの傾動により変位する第1変位部640Aa〜620Daと、各固定部616、617から離間し各第2傾動部613Ab〜613Dbの傾動により変位する第2変位部640Ab〜620Dbと、を有している。 As shown in FIG. 38, displacement bodies 620Aa to 620Da and 620Ab to 620Db that are displaced by elastic deformation generated in the deformation elements 610A to 610D are connected to the deformation elements 610A to 610D. In the present embodiment, a displacement body is connected to each tilting portion. Specifically, the displacement bodies are separated from the first displacement portions 640Aa to 620Da, which are separated from the fixed portions 616 and 617 and displaced by the tilt of the first tilting portions 613Aa to 613D, and separated from the fixed portions 616 and 617, respectively. It has second displacement portions 640Ab to 620Db that are displaced by tilting of the second tilt portions 613Ab to 613Db.

力覚センサ600cは、これらの変位体に生じる変位に基づいて、作用した力及びモーメントの少なくとも一方を検出する検出回路640と、を更に備えている。 The force sensor 600c further includes a detection circuit 640 that detects at least one of the acting force and the moment based on the displacement generated in these displacement bodies.

検出回路640は、各第1変位部640Aa〜620Daに配置された第1変位センサと、各第2変位部640Ab〜620Dbに配置された第2変位センサと、を有している。図38に示す例では、第1変位センサ及び第2変位センサは、後述されるように、容量素子C11〜C82である。検出回路640は、第1変位センサの検出値に基づいて、作用した力を示す第1電気信号T1を出力し、且つ、各第2変位センサの検出値に基づいて、作用した力を示す第2電気信号T2を出力し、当該第1電気信号T1と当該第2電気信号T2との比率の変化に基づいて、力の検出が正常に行われているか否かを判定するようになっている。 The detection circuit 640 has a first displacement sensor arranged in each of the first displacement portions 640Aa to 620Da, and a second displacement sensor arranged in each of the second displacement portions 640Ab to 620Db. In the example shown in FIG. 38, the first displacement sensor and the second displacement sensor are capacitive elements C11 to C82, as will be described later. The detection circuit 640 outputs a first electric signal T1 indicating the applied force based on the detected value of the first displacement sensor, and indicates the applied force based on the detected value of each second displacement sensor. 2 The electric signal T2 is output, and it is determined whether or not the force is normally detected based on the change in the ratio of the first electric signal T1 and the second electric signal T2. ..

図38に示すように、第1変位部640Aa〜620Daは、第1傾動部613Aa〜613Daの長手方向と交差する方向に延在する第1梁621Aa〜621Daを有し、第2変位部640Ab〜620Dbは、第2傾動部613Ab〜613Dbの長手方向と交差する方向に延在する第2梁621Ab〜621Dbを有している。 As shown in FIG. 38, the first displacement portions 640Aa to 620Da have first beams 621Aa to 621Da extending in a direction intersecting the longitudinal direction of the first tilting portions 613Aa to 613Da, and the second displacement portions 640Ab to 620Da. The 620Db has second beams 621Ab to 621Db extending in a direction intersecting the longitudinal direction of the second tilting portions 613Ab to 613Db.

第1梁621Aa〜621Daには、それぞれ、当該第1梁621Aa〜621Daの一方の端部(受力部618、619側の端部)から他方の端部(固定部616、617側の端部)に向かって、第1−1計測部位D11、D42、D51、D82及び第1−2計測部位D12、D41、D52、D81がこの順序で規定されている。同様に、第2梁621Ab〜621Dbには、それぞれ、当該第2梁621Ab〜621Dbの一方の端部(受力部618、619側の端部)から他方の端部(固定部616、617側の端部)に向かって第2−1計測部位D21、D32、D61、D72及び第2−2計測部位D22、D31、D62、D71がこの順序で規定されている。 The first beams 621Aa to 621Da have one end (the end on the receiving portion 618 and 619 side) to the other end (the end on the fixed portion 616 and 617 side) of the first beam 621Aa to 621Da, respectively. ), The 1-1 measurement sites D11, D42, D51, D82 and the 1-2 measurement sites D12, D41, D52, D81 are defined in this order. Similarly, the second beams 621Ab to 621Db have one end (ends on the receiving portions 618 and 619 sides) to the other end (fixed portions 616 and 617 sides) of the second beams 621Ab to 621Db, respectively. The 2-1 measurement sites D21, D32, D61, D72 and the 2-2 measurement sites D22, D31, D62, D71 are defined in this order toward the end of the 2-1 measurement site.

図38に示すように、各第1変位部620Aa〜620Daは、変形体610の第1傾動部613Aa〜613Daと第1梁621Aa〜621Daとを接続する第1接続体622Aa〜622Daを有し、各第2変位部620Ab〜620Dbは、変形体610の第2傾動部613Ab〜613Dbと第2梁621Ab〜621Dbとを接続する第2接続体622Ab〜622Dbを有している。そして、各計測部位D11〜D82は、対応する接続体622Aa〜622Da、622Ab〜622Dbと梁621Aa〜621Da、621Ab〜621Dbとの接続部位に関して対称的に配置されている。 As shown in FIG. 38, each of the first displacement portions 620Aa to 620Da has first connecting bodies 622Aa to 622Da that connect the first tilting portions 613Aa to 613Da of the deformed body 610 and the first beams 621Aa to 621Da. Each of the second displacement portions 620Ab to 620Db has second connecting bodies 622Ab to 622Db that connect the second tilting portions 613Ab to 613Db of the deformed body 610 and the second beams 621Ab to 621Db. The measurement sites D11 to D82 are arranged symmetrically with respect to the connection sites of the corresponding connecting bodies 622Aa to 622Da and 622Ab to 622Db and the beams 621Aa to 621Da and 621Ab to 621Db.

検出回路640は、第1−1変位センサ及び第1−2変位センサ、すなわち8つの容量素子C11、C12、C41、C42、C51、C52、C81、C82の各検出値(静電容量値)に基づいて第1電気信号T1を出力し、且つ、第2−1変位センサ及び第2−2変位センサ、すなわち残り8つの容量素子C21、C22、C31、C32、C61、C62、C71、C72の各検出値(静電容量値)に基づいて第2電気信号T2を出力するようになっている。各電気信号T1、T2を示す式は、後述される。 The detection circuit 640 sets the detection values (capacitance values) of the 1-1 displacement sensor and the 1-2 displacement sensor, that is, the eight capacitance elements C11, C12, C41, C42, C51, C52, C81, and C82. Based on this, the first electric signal T1 is output, and the 2-1 displacement sensor and the 2-2 displacement sensor, that is, the remaining eight capacitive elements C21, C22, C31, C32, C61, C62, C71, and C72, respectively. The second electric signal T2 is output based on the detected value (capacitance value). The formulas showing the electric signals T1 and T2 will be described later.

本実施の形態では、図27に示す力覚センサ300cと同様に、変位体に対向配置され、固定部616、617に対して移動しない支持体650を更に備えている。そして、前記第1及び第2変位センサは、変位体の各変位部420Aa〜420Dbに配置された変位電極Em11〜Em82と、この変位電極Em11〜Em82に対向して支持体650上に配置された固定電極Ef11〜Ef82(不図示)と、を有する容量素子である。 In the present embodiment, similarly to the force sensor 300c shown in FIG. 27, a support 650 that is arranged to face the displacement body and does not move with respect to the fixed portions 616 and 617 is further provided. The first and second displacement sensors are arranged on the displacement electrodes Em11 to Em82 arranged on the displacement portions 420Aa to 420Db of the displacement body and on the support 650 facing the displacement electrodes Em11 to Em82. It is a capacitive element having fixed electrodes Ef11 to Ef82 (not shown).

また、本実施の形態の検出回路640の構成は、入力される静電容量値がC11〜C82に増加している点を除き、図13に示すブロック図と同様である。したがって、検出回路640は、力の検出が正常に行われているときの、すなわち変形体610に金属疲労が生じていないときの、第1電気信号T1と第2電気信号T2との比率を基準比率Rsとして記憶する記憶部を有している。そして、検出回路640は、第1電気信号T2と第2電気信号T2との比率と、基準比率Rsと、の差、に基づいて、力の検出が正常に行われているか否か、とりわけ変形体610に金属疲労が生じているか否か、を判定するようになっている。 Further, the configuration of the detection circuit 640 of the present embodiment is the same as the block diagram shown in FIG. 13 except that the input capacitance value is increased from C11 to C82. Therefore, the detection circuit 640 is based on the ratio of the first electric signal T1 and the second electric signal T2 when the force is normally detected, that is, when metal fatigue does not occur in the deformed body 610. It has a storage unit that stores it as a ratio Rs. Then, the detection circuit 640 deforms whether or not the force is normally detected based on the difference between the ratio of the first electric signal T2 and the second electric signal T2 and the reference ratio Rs. It is designed to determine whether or not metal fatigue has occurred in the body 610.

< 6−2. 力覚センサの作用 >
以上の力覚センサ600cにおいて、受力部618、619にある方向の力が作用した際、第2象限に位置する第1変形要素610Aの第1傾動部613Aa及び第2傾動部613Abに生じる傾動(回動)の向きは、同じ方向の力が第3の実施の形態による力覚センサ300c(図27参照)に作用した際に第1変形要素310Aの傾動部313Aに生じる傾動(回動)の向きと同じである。すなわち、力Fx、Fy、Fz及びモーメントMx、My、Mzが作用した際に、第3の実施の形態による力覚センサ300cの第1計測部位D1のZ軸方向に沿った変位の向きと、本実施の形態による力覚センサ600cの第1−1計測部位D11及び第1−2計測部位D12のZ軸方向に沿った変位の向きとは、同じである。同様に、第3の実施の形態による力覚センサ300cの第2計測部位D2のZ軸方向に沿った変位の向きと、本実施の形態による力覚センサ600cの第2−1計測部位D21及び第2−2計測部位D22のZ軸方向に沿った変位の向きとは、同じである。
<6-2. Action of force sensor >
In the above force sensor 600c, when a force in the direction in the receiving portions 618 and 619 acts, the tilt generated in the first tilting portion 613Aa and the second tilting portion 613Ab of the first deforming element 610A located in the second quadrant. The direction of (rotation) is the tilt (rotation) that occurs in the tilting portion 313A of the first deformation element 310A when a force in the same direction acts on the force sensor 300c (see FIG. 27) according to the third embodiment. It is the same as the direction of. That is, when the forces Fx, Fy, Fz and the moments Mx, My, Mz act, the direction of displacement of the first measurement portion D1 of the force sensor 300c according to the third embodiment along the Z-axis direction. The direction of displacement of the force sensor 600c according to the present embodiment along the Z-axis direction of the 1-1 measurement portion D11 and the 1-2 measurement portion D12 is the same. Similarly, the direction of displacement of the second measurement site D2 of the force sensor 300c according to the third embodiment along the Z-axis direction, and the 2-1 measurement site D21 and the force sensor 600c according to the present embodiment. The direction of displacement of the second 2nd measurement site D22 along the Z-axis direction is the same.

このような対応関係は、第2〜第4変形要素610B〜610Dにおいても、同様に成立する。すなわち、受力部618、619に力が作用した際、第3−1計測部位D31及び第4−1計測部位D41の挙動と図27に示す力覚センサ300の第3計測部位D3の挙動とが対応し、第3−2計測部位D32及び第4−2計測部位D42の挙動と図27に示す力覚センサ300の第4計測部位D4の挙動とが対応し、第5−1計測部位D51及び第6−1計測部位D61の挙動と図27に示す力覚センサ300の第5計測部位D5の挙動とが対応し、第5−2測部位D52及び第6−2計測部位D62の挙動と図27に示す力覚センサ300の第6計測部位D6の挙動とが対応し、第7−1計測部位D71及び第8−1計測部位D81の挙動と図27に示す力覚センサ300の第7計測部位D7の挙動とが対応し、第7−2計測部位D72及び第8−2計測部位D82の挙動と図27に示す力覚センサ300の第8計測部位D8の挙動とが対応する。 Such a correspondence is also established in the second to fourth deformation elements 610B to 610D. That is, when a force acts on the receiving parts 618 and 619, the behavior of the 3-1 measurement part D31 and the 4-1 measurement part D41 and the behavior of the third measurement part D3 of the force sensor 300 shown in FIG. 27. Corresponds, and the behavior of the 3rd-2nd measurement part D32 and the 4-2th measurement part D42 corresponds to the behavior of the 4th measurement part D4 of the force sensor 300 shown in FIG. 27, and the 5-1th measurement part D51 And the behavior of the 6-1st measurement part D61 and the behavior of the 5th measurement part D5 of the force sensor 300 shown in FIG. 27 correspond to the behavior of the 5-2nd measurement part D52 and the 6-2th measurement part D62. The behavior of the sixth measurement site D6 of the force sensor 300 shown in FIG. 27 corresponds to the behavior of the 7-1 measurement site D71 and the 8-1 measurement site D81, and the behavior of the force sensor 300 shown in FIG. 27 is the seventh. The behavior of the measurement site D7 corresponds to the behavior of the 7-2 measurement site D72 and the 8-2 measurement site D82, and the behavior of the eighth measurement site D8 of the force sensor 300 shown in FIG. 27 corresponds.

更に、各変形部611Aa〜611Da、612Aa〜612Da、611Ab〜611Db、612Ab〜612Dbのバネ定数の相違から、各変形要素610A〜610Dに含まれる各2つの変位部620Aa〜620Da、620Ab〜620Abのうち、受力部618、619に近位の変位部620Aa〜620Daに規定された計測部位D11、D12、D41、D42、D51、D52、D81、D82の方が、Z軸方向の変位が相対的に大きい。 Further, due to the difference in the spring constants of the deformed portions 611Aa to 611Da, 612Aa to 612Da, 611Ab to 611Db, and 612Ab to 612Db, among the two displacement portions 620Aa to 620Da and 620Ab to 620Ab included in the deforming elements 610A to 610D. The displacements in the Z-axis direction are relatively larger for the measurement sites D11, D12, D41, D42, D51, D52, D81, and D82 defined in the displacement portions 620Aa to 620Da proximal to the receiving portions 618 and 619. big.

以上の対応関係及び計測部位D11〜D82の変位の大小関係と、図29の図表と、を踏まえると、力覚センサ600cの各容量素子C11〜C82の静電容量値の増減は、図39に示す通りである。この図表においても、「+」は、静電容量値が増大することを示しており、「++」は、静電容量値が大きく増大することを示している。また、「−」は、静電容量値が減少することを示しており、「−−」は、静電容量値が大きく減少することを示している。 Based on the above correspondence, the magnitude relationship of the displacements of the measurement sites D11 to D82, and the chart of FIG. 29, the increase / decrease of the capacitance value of each capacitance element C11 to C82 of the force sensor 600c is shown in FIG. 39. As shown. Also in this chart, "+" indicates that the capacitance value increases, and "++" indicates that the capacitance value increases significantly. Further, "-" indicates that the capacitance value decreases, and "-" indicates that the capacitance value decreases significantly.

このような力覚センサ600cでは、図39に基づき、以下の[式23]及び[式24]に基づいて受力部618、619に作用した力を計測することができる。各式の左辺の末尾の数字が「1」である[式23]は、相対的にバネ定数が小さい変形部によって支持された第1、第4、第5及び第8傾動部613A、613D、613E、613Hに関連付けられた容量素子を用いて計測された力である。また、各式の左辺の末尾の数字が「2」である[式24]は、相対的にバネ定数が大きい変形部によって支持された第2、第3、第6及び第7傾動部613B、613C、613F、613Gに関連付けられた容量素子を用いて計測された力である。
[式23]
Fx1=C11−C12+C41−C42−C51+C52−C81+C82
Fy1=C11−C12−C41+C42−C51+C52+C81−C82
Fz1=−C11+C12+C41−C42−C51+C52+C81−C82
Mx1=−C11+C12+C41−C42+C51−C52−C81+C82
My1=−C11+C12−C41+C42+C51−C52+C81−C82
Mz1=−C11+C12−C41+C42−C51+C52−C81+C82
[式24]
Fx2=C21−C22+C31−C32−C61+C62−C71+C72
Fy2=C21−C22−C31+C32−C61+C62+C71−C72
Fz2=−C21+C22+C31−C32−C61+C62+C71−C72
Mx2=−C21+C22+C31−C32+C61−C62−C71+C72
My2=−C21+C22−C31+C32+C61−C62+C71−C72
Mz2=−C21+C22−C31+C32−C61+C62−C71+C72
With such a force sensor 600c, it is possible to measure the force acting on the receiving units 618 and 619 based on the following [Equation 23] and [Equation 24] based on FIG. 39. [Equation 23], in which the number at the end of the left side of each equation is "1", is the first, fourth, fifth and eighth tilting portions 613A, 613D supported by the deformed portions having a relatively small spring constant. The force measured using the capacitive elements associated with the 613E, 613H. Further, in [Equation 24] in which the number at the end of the left side of each equation is "2", the second, third, sixth and seventh tilting portions 613B supported by the deformed portions having a relatively large spring constant, The force measured using the capacitive elements associated with the 613C, 613F, 613G.
[Equation 23]
Fx1 = C11-C12 + C41-C42-C51 + C52-C81 + C82
Fy1 = C11-C12-C41 + C42-C51 + C52 + C81-C82
Fz1 = -C11 + C12 + C41-C42-C51 + C52 + C81-C82
Mx1 = -C11 + C12 + C41-C42 + C51-C52-C81 + C82
My1 = -C11 + C12-C41 + C42 + C51-C52 + C81-C82
Mz1 = -C11 + C12-C41 + C42-C51 + C52-C81 + C82
[Equation 24]
Fx2 = C21-C22 + C31-C32-C61 + C62-C71 + C72
Fy2 = C21-C22-C31 + C32-C61 + C62 + C71-C72
Fz2 = -C21 + C22 + C31-C32-C61 + C62 + C71-C72
Mx2 = -C21 + C22 + C31-C32 + C61-C62-C71 + C72
My2 = -C21 + C22-C31 + C32 + C61-C62 + C71-C72
Mz2 = -C21 + C22-C31 + C32-C61 + C62-C71 + C72

ところで、本実施の形態による力覚センサ600cは、Fx1=My1、Fy1=Mx1、Fx2=My2、Fy2=Mx2という関係が成立している。このため、力覚センサ600cは、力の6つの成分のすべてを検出することはできない。すなわち、この力覚センサ600cは、Fz、Mx、My及びMzの4つの成分、または、Fx、Fy、Fz及びMzの4つの成分、のいずれかであれば、各成分を計測することができる。なお、このことは、力覚センサ600cと第3の実施の形態による力覚センサ300cとの対応関係からも明らかである。 By the way, in the force sensor 600c according to the present embodiment, the relationship of Fx1 = My1, Fy1 = Mx1, Fx2 = My2, Fy2 = Mx2 is established. Therefore, the force sensor 600c cannot detect all six components of force. That is, the force sensor 600c can measure each component if it is any one of the four components of Fz, Mx, My and Mz, or the four components of Fx, Fy, Fz and Mz. .. This is clear from the correspondence between the force sensor 600c and the force sensor 300c according to the third embodiment.

< 6−3. 故障診断 >
上述したように、本実施の形態の検出回路640も、力覚センサ600cが正常に機能しているか否かを判定する機能を有している。ここでは、この故障診断の機能について説明を行う。
<6-3. Failure diagnosis >
As described above, the detection circuit 640 of the present embodiment also has a function of determining whether or not the force sensor 600c is functioning normally. Here, the function of this failure diagnosis will be described.

この故障診断の手法は、2−5.で説明した故障診断の手法と同様である。すなわち、例えば力Fxに着目した場合、第1電気信号T1及び第2電気信号T2は次の[式25]の通りである。
[式25]
T1=C11−C12+C41−C42−C51+C52−C81+C82
T2=C21−C22+C31−C32−C61+C62−C71+C72
This failure diagnosis method is 2-5. This is the same as the failure diagnosis method described in. That is, for example, when focusing on the force Fx, the first electric signal T1 and the second electric signal T2 are as shown in the following [Equation 25].
[Equation 25]
T1 = C11-C12 + C41-C42-C51 + C52-C81 + C82
T2 = C21-C22 + C31-C32-C61 + C62-C71 + C72

ここで、力覚センサ600cの変形体610に金属疲労が生じていないときの、受力部618、619に作用するX軸正方向の力+Fxと電気信号T1、T2との関係は、図15に示す通りであった。更に、力覚センサ600cの変形体610に金属疲労が生じているときの、受力部618、619に作用するX軸正方向の力+Fxと電気信号T1、T2との関係は、図16に示す通りであった。すなわち、力覚センサ600cの変形体610に金属疲労が生じていないときには、第1電気信号T1を示すグラフT1aの傾きと、第2電気信号T2を示すグラフT2aの傾きと、の比は、4である。また、力覚センサ600cの変形体610に金属疲労が生じているときには、第1電気信号T1を示すグラフT1bの傾きと、第2電気信号T2を示すグラフT2bの傾きと、の比は、5である。 Here, the relationship between the X-axis positive force + Fx acting on the receiving portions 618 and 619 and the electric signals T1 and T2 when the deformed body 610 of the force sensor 600c is not subjected to metal fatigue is shown in FIG. It was as shown in. Further, the relationship between the force + Fx in the positive direction of the X-axis acting on the receiving portions 618 and 619 and the electric signals T1 and T2 when the deformed body 610 of the force sensor 600c is subjected to metal fatigue is shown in FIG. It was as shown. That is, when metal fatigue does not occur in the deformed body 610 of the force sensor 600c, the ratio of the inclination of the graph T1a showing the first electric signal T1 to the inclination of the graph T2a showing the second electric signal T2 is 4. Is. Further, when metal fatigue occurs in the deformed body 610 of the force sensor 600c, the ratio of the inclination of the graph T1b showing the first electric signal T1 to the inclination of the graph T2b showing the second electric signal T2 is 5. Is.

したがって、第2の実施の形態による力覚センサ200cと同様に、本実施の形態でも、各グラフの傾きの比(T1/T2)の変化を利用して力覚センサ600cの故障診断を行う。すなわち、検出回路640のマイコン644は、作用した力を、相対的にバネ定数が大きい変形部に関連付けられた第2電気信号T2を用いて計測しつつ、現在の第1電気信号T1と第2電気信号T2との比率と、金属疲労が発現していない初期状態における第1電気信号T1aと第2電気信号T2aとの比率と、の差が所定の範囲内にあるか否かを評価することによって、力覚センサ600cが正常に機能しているか否かを判定することができる。 Therefore, similarly to the force sensor 200c according to the second embodiment, in the present embodiment as well, the failure diagnosis of the force sensor 600c is performed by utilizing the change in the inclination ratio (T1 / T2) of each graph. That is, the microcomputer 644 of the detection circuit 640 measures the applied force using the second electric signal T2 associated with the deformed portion having a relatively large spring constant, while measuring the current first electric signal T1 and the second electric signal T1. To evaluate whether or not the difference between the ratio of the electric signal T2 and the ratio of the first electric signal T1a and the second electric signal T2a in the initial state in which metal fatigue does not occur is within a predetermined range. It is possible to determine whether or not the force sensor 600c is functioning normally.

もちろん、作用した力を、第1電気信号T1に基づいて計測しても良い。この場合、第1電気信号T1を提供する容量素子はバネ定数が相対的に小さい変形部に関連付けられているため、作用する力に対する感度が高く、S/Nに優れた力の計測が可能となる。また、各容量素子C11〜C82の静電容量値の変動量をAD変換し、マイコン644によって各静電容量値を比較することによって、力覚センサ600cの故障を診断しても良い。 Of course, the acting force may be measured based on the first electric signal T1. In this case, since the capacitive element that provides the first electric signal T1 is associated with the deformed portion having a relatively small spring constant, the sensitivity to the acting force is high, and it is possible to measure the force excellent in S / N. Become. Further, the failure of the force sensor 600c may be diagnosed by AD-converting the fluctuation amount of the capacitance values of the capacitance elements C11 to C82 and comparing the capacitance values with the microcomputer 644.

故障診断を行う手順は、2−5.で説明した手順と同様であるため、ここではその詳細な説明を省略する。 The procedure for failure diagnosis is 2-5. Since the procedure is the same as that described in the above, the detailed description thereof will be omitted here.

以上のような本実施の形態によれば、相対的に静電容量値の変動が大きい容量素子に基づく第1電気信号T1と、相対的に静電容量値の変動が小さい容量素子に基づく第2電気信号T2と、の比率の変化に基づいて、力覚センサ600cの故障診断が行われる。この故障診断では、容量素子C11〜C82の電極に生じた異常のみならず、変形体610に生じた金属疲労に起因する力覚センサ600cの故障をも自ら診断することができる。さらに、力覚センサ600cにおいては、傾動部213A、213bの傾動によって各計測部位D11〜D82が変位するため、傾動部13に生じる傾動を効果的に増幅させることができる。すなわち、本実施の形態によれば、低価格且つ高感度でありながら、単一の力覚センサ600cによってそれ自身の故障診断が可能である、という力覚センサ600cを提供することができる。 According to the present embodiment as described above, the first electric signal T1 based on the capacitance element having a relatively large fluctuation in the capacitance value and the first electric signal T1 based on the capacitance element having a relatively small fluctuation in the capacitance value. Based on the change in the ratio of the two electrical signals T2, the failure diagnosis of the force sensor 600c is performed. In this failure diagnosis, not only the abnormality generated in the electrodes of the capacitive elements C11 to C82 but also the failure of the force sensor 600c caused by the metal fatigue generated in the deformed body 610 can be diagnosed by oneself. Further, in the force sensor 600c, since the measurement sites D11 to D82 are displaced by the tilting of the tilting portions 213A and 213b, the tilting generated in the tilting portion 13 can be effectively amplified. That is, according to the present embodiment, it is possible to provide a force sensor 600c that can diagnose its own failure by a single force sensor 600c while being inexpensive and having high sensitivity.

また、本実施の形態においても、検出回路640は、静電容量値の差分によって作用した力Fx、Fy、Fz及びモーメントMx、My、Mzを計測するため、使用環境の温度変化や同相ノイズの影響を受けにくい力覚センサ600cを提供することができる。 Further, also in the present embodiment, since the detection circuit 640 measures the forces Fx, Fy, Fz and the moments Mx, My, Mz acting by the difference in the capacitance value, the temperature change in the usage environment and the common mode noise It is possible to provide a force sensor 600c that is not easily affected.

また、各計測部位D11〜D82は、対応する接続体と梁との接続部位に関して対称的に配置されているため、作用した力を簡易な演算によって検出することができる。 Further, since the measurement portions D11 to D82 are arranged symmetrically with respect to the connection portion between the corresponding connecting body and the beam, the applied force can be detected by a simple calculation.

<<< §7. 本発明の変形例による力覚センサ >>>
< 7−1. 変形例1 >
図40は、図27の変形例による力覚センサ302cを示す概略上面図である。本図においても、説明の便宜上、受力体の図示が省略されている。
<<< §7. Force sensor according to a modified example of the present invention >>>
<7-1. Modification 1>
FIG. 40 is a schematic top view showing the force sensor 302c according to the modified example of FIG. 27. Also in this figure, the illustration of the receiving body is omitted for convenience of explanation.

図40に示すように、力覚センサ302cは、変形体310bが矩形の形状を有している点で、図27に示す力覚センサ300cとは異なっている。変形体310bは、X軸上に原点Oを挟んで対称的に配置された2つの受力部318b、319bと、Y軸上に原点Oを挟んで対称的に配置された3つの固定部316b、317bとを有している。そして、閉ループ状の経路に沿って隣接する受力部と固定部とが、直線状の4つの変形要素310Ab〜210Dbによって連結されている。したがって、力覚センサ302cの基本構造302は、2つの受力部318b、319b及び2つの固定部316b、317bを4つの頂点とする矩形の形状を有しており、この矩形の4つの辺上に、変形要素210Ab〜210Dbが1つずつ配置されている。 As shown in FIG. 40, the force sensor 302c is different from the force sensor 300c shown in FIG. 27 in that the deformed body 310b has a rectangular shape. The deformed body 310b has two receiving portions 318b and 319b symmetrically arranged on the X-axis with the origin O in between, and three fixed portions 316b symmetrically arranged on the Y-axis with the origin O in between. It has 317b. Then, the receiving portion and the fixing portion adjacent to each other along the closed loop-shaped path are connected by four linear deformation elements 310Ab to 210Db. Therefore, the basic structure 302 of the force sensor 302c has a rectangular shape having two receiving portions 318b, 319b and two fixing portions 316b and 317b as four vertices, and is on the four sides of the rectangle. The deforming elements 210Ab to 210Db are arranged one by one.

その他の構成については、図27に示す力覚センサ200cと略同様である。このため、図40において、図27に示す力覚センサ300cと対応する構成要素に略同様の符号(末尾に「b」を付加)を付し、その詳細な説明を省略する。 Other configurations are substantially the same as those of the force sensor 200c shown in FIG. 27. Therefore, in FIG. 40, substantially the same reference numerals (“b” is added at the end) to the components corresponding to the force sensor 300c shown in FIG. 27 are added, and detailed description thereof will be omitted.

以上の力覚センサ302cは、結局、図27に示す力覚センサ300cの各変形要素310A〜310Dを弧状ではなく直線状に構成したものである。従って、図40に示す力覚センサ302cに力及びモーメントが作用したときに、各変形要素310Ab〜310Dbに生じる弾性変形は、実質的に図27に示す力覚センサ300cと同様である。すなわち、作用する力及びモーメントに対して、本変形例による力覚センサ302cの各容量素子C11〜C82の静電容量値は、図29に記載された通りに変動する。 In the above-mentioned force sensor 302c, after all, the deformation elements 310A to 310D of the force sensor 300c shown in FIG. 27 are formed not in an arc shape but in a straight line shape. Therefore, when a force and a moment are applied to the force sensor 302c shown in FIG. 40, the elastic deformation generated in each of the deformation elements 310Ab to 310Db is substantially the same as that of the force sensor 300c shown in FIG. 27. That is, the capacitance values of the capacitance elements C11 to C82 of the force sensor 302c according to this modification vary with respect to the acting force and moment as shown in FIG. 29.

したがって、以上のような本変形例による力覚センサ302cによっても、図27に示す力覚センサ300cと同様の作用効果が提供され得る。 Therefore, the force sensor 302c according to the present modification as described above can also provide the same action and effect as the force sensor 300c shown in FIG. 27.

< 7−2. 変形例2 >
次に、図41は、図27の更なる変形例による力覚センサ700cを示す概略上面図である。ここでも、図41に示すようにXYZ三次元座標系を定義して以下の説明を行うこととする。なお、図41でも、説明の便宜上、受力体760の図示が省略されている。
<7-2. Modification 2>
Next, FIG. 41 is a schematic top view showing a force sensor 700c according to a further modification of FIG. 27. Here, too, the XYZ three-dimensional coordinate system is defined as shown in FIG. 41, and the following description will be given. Also in FIG. 41, the illustration of the receiving body 760 is omitted for convenience of explanation.

図41に示すように、力覚センサ700cは、XY平面上に配置された、原点Oを中心とする閉ループ状の環状変形体710を備えている。環状変形体710は、4つの受力部714A、714B、714D、714Fと、閉ループ状の経路に沿って前記4つの受力部714A、714B、714D、714Fと交互に配置された4つの固定部715B、715C、715E、715Hと、閉ループ状の経路に沿って隣接する受力部及び固定部によって挟まれた8つの間隙に1つずつ配置され、受力部714A、714B、714D、714Fに作用した力またはモーメントにより弾性変形を生じる8つの変形要素710A〜710Hと、を有している。更に、力覚センサ700cは、各変形要素710A〜710Hに接続され、当該変形要素710A〜710Hに生じる弾性変形により変位を生じる8つの変位体720A〜720Hと、を備えている。 As shown in FIG. 41, the force sensor 700c includes a closed loop-shaped annular plasmodium 710 arranged on the XY plane and centered on the origin O. The annular deformed body 710 has four fixed portions alternately arranged with four receiving portions 714A, 714B, 714D, 714F and the four receiving portions 714A, 714B, 714D, 714F along a closed loop path. 715B, 715C, 715E, 715H are arranged one by one in eight gaps sandwiched by adjacent receiving parts and fixing parts along a closed loop path, and act on the receiving parts 714A, 714B, 714D, 714F. It has eight deformation elements 710A to 710H, which cause elastic deformation due to the applied force or moment. Further, the force sensor 700c includes eight displacement bodies 720A to 720H which are connected to the deformation elements 710A to 710H and cause displacement due to elastic deformation generated in the deformation elements 710A to 710H.

図41に示すように、4つの受力部714A、714B、714D、714Fは、X軸上及びY軸上に原点Oから等距離で配置されている。また、4つの固定部715B、715C、715E、715Hは、原点Oを通り正のX軸に対して反時計回りに45°の角度を成す直線上、及び、原点Oを通り正のY軸に対して反時計回りに45°の角度を成す直線上、にそれぞれ原点Oに関して対称的に1つずつ配置されている。 As shown in FIG. 41, the four receiving portions 714A, 714B, 714D, and 714F are arranged on the X-axis and the Y-axis at equal distances from the origin O. Further, the four fixing portions 715B, 715C, 715E, and 715H pass through the origin O on a straight line forming an angle of 45 ° counterclockwise with respect to the positive X axis, and pass through the origin O on the positive Y axis. On the other hand, one is symmetrically arranged with respect to the origin O on a straight line forming an angle of 45 ° counterclockwise.

本実施の形態の各変形要素710A〜710Hの構成は、上述した第3の実施の形態による基本構造300の変形要素310A〜310Dの構成と実質的に同様である。具体的には、図41に示す第1変形要素710A、第4変形要素710D、第5変形要素710E及び第8変形要素710Hは、図17に示す第1変形要素310A、第2変形要素310B、第3変形要素710C及び第4変形要素710Dと、それぞれ同様の構成を有している。残りの第2変形要素710B、第3変形要素710C、第6変形要素710F及び第7変形要素710Gは、それぞれ、第1変形要素710A、第4変形要素710D、第5変形要素710E及び第8変形要素710HをZ軸周りに90°回転させたものである。以上の対応関係は、本実施の形態の8つの変位体720A〜720Hについても、同様に成立する。結局、基本構造700は、第1〜第8変形要素710A〜710Hとして、§1で説明した基本構造100を8つ、環状の閉ループ状に配置されて構成されている。 The configurations of the deformable elements 710A to 710H of the present embodiment are substantially the same as the configurations of the deformable elements 310A to 310D of the basic structure 300 according to the third embodiment described above. Specifically, the first deforming element 710A, the fourth deforming element 710D, the fifth deforming element 710E and the eighth deforming element 710H shown in FIG. 41 are the first deforming element 310A and the second deforming element 310B shown in FIG. It has the same configuration as the third deformable element 710C and the fourth deformable element 710D, respectively. The remaining second deformation element 710B, third deformation element 710C, sixth deformation element 710F, and seventh deformation element 710G are the first deformation element 710A, the fourth deformation element 710D, the fifth deformation element 710E, and the eighth deformation, respectively. The element 710H is rotated by 90 ° around the Z axis. The above correspondence is similarly established for the eight displacement bodies 720A to 720H of the present embodiment. After all, the basic structure 700 is configured by arranging eight basic structures 100 described in §1 as the first to eighth deformation elements 710A to 710H in an annular closed loop shape.

基本構造700の各固定部715B、715C、715E、715Hは、その下端部が、第1〜第8梁721A〜721Hに所定の間隔を空けて対向配置された支持体750に接続されている。更に、環状変形体710のZ軸正側には、検出対象の力を受けるための受力体760(不図示)が配置されている。支持体750及び受力体760と各固定部715B、715C、715E、715H及び各受力部714A、714B、714D、714Fとの関係は、第3の実施の形態(図18、図19等参照)と実質的に同様であるため、ここではその詳細な説明を省略する。 The lower ends of the fixing portions 715B, 715C, 715E, and 715H of the basic structure 700 are connected to the supports 750 which are arranged to face the first to eighth beams 721A to 721H at predetermined intervals. Further, a receiving body 760 (not shown) for receiving a force to be detected is arranged on the Z-axis positive side of the annular deformed body 710. The relationship between the support body 750 and the receiving body 760 and the fixed portions 715B, 715C, 715E, 715H and the receiving portions 714A, 714B, 714D, 714F is the third embodiment (see FIGS. 18, 19 and the like). ), Therefore a detailed description thereof will be omitted here.

更に、本変形例による力覚センサ700cは、基本構造700の各計測部位D11〜D82に各2つずつ配置された合計32個の容量素子C11a〜C82bを含む検出回路740を有している。各梁721A〜721Hにおける容量素子C11a〜C81bの配置は、第3の実施の形態(図27参照)と同様であるため、その詳細な説明を省略する。 Further, the force sensor 700c according to the present modification has a detection circuit 740 including a total of 32 capacitive elements C11a to C82b arranged in each of the measurement sites D11 to D82 of the basic structure 700. Since the arrangement of the capacitive elements C11a to C81b in the beams 721A to 721H is the same as that of the third embodiment (see FIG. 27), detailed description thereof will be omitted.

次に、図42は、受力部760にXYZ三次元座標系における各軸方向の力及び各軸方向のモーメントFx〜Mzが作用したときに、図41の力覚センサの各傾動部713A〜713Hに生じる傾動の向きと、各変位部D11〜D82に生じる変位とを、一覧で示す図表である。 Next, FIG. 42 shows each tilting portion 713A to the force sensor of FIG. 41 when a force in each axial direction and moments Fx to Mz in each axial direction are applied to the force receiving portion 760 in the XYZ three-dimensional coordinate system. It is a chart which shows the direction of the tilt generated in 713H, and the displacement generated in each displacement part D11-D82 in a list.

図42に示す図表では、変形要素が相対的に小さい弾性変形を呈することによって、相対的に小さい傾動を示す傾動部、及び、相対的に小さい変位を示す変位部、に対応する欄には、括弧付きで傾動の向き及び変位の符号を示してある。図示しないが、XYZ三次元座標系における各軸方向の力及び各軸方向のモーメントFx〜Mzが作用したときに各容量素子C11〜C82に生じる静電容量値の変動は、図42の表において、当該容量素子C11〜C82に対応する変位部D11〜D82の欄に示す変位の符号を反転させればよい。この場合、「+」の符号は静電容量値の増大を表し、「−」の符号は静電容量値の減少を表す。 In the chart shown in FIG. 42, the columns corresponding to the tilting portion showing a relatively small tilt and the displacement portion showing a relatively small displacement due to the deformation element exhibiting a relatively small elastic deformation are displayed. The signs of tilt direction and displacement are shown in parentheses. Although not shown, the fluctuations in the capacitance values that occur in the capacitance elements C11 to C82 when a force in each axial direction and moments Fx to Mz in each axial direction act in the XYZ three-dimensional coordinate system are shown in the table of FIG. , The sign of the displacement shown in the column of the displacement portions D11 to D82 corresponding to the capacitance elements C11 to C82 may be inverted. In this case, the sign of "+" represents an increase in the capacitance value, and the sign of "-" represents a decrease in the capacitance value.

そして、検出回路740のマイコン744は、作用した力及びモーメントFx〜Mzを次の[式26]及び[式27]により計測する。各式の左辺の末尾の数字が「1」である[式26]は、相対的に梁の端部側に位置する、末尾に「a」が付された容量素子に基づいている。一方、各式の左辺の末尾の数字が「2」である[式27]は、相対的に梁の内側に位置する、末尾に「b」が付された容量素子に基づいている。
[式26]
+Fx1=C11a−C12a+C21a−C22a+C31a−C32a+C41a−C42a−C51a+C52a−C61a+C62a−C71a+C72a−C81a+C82a
+Fy1=C11a−C12a+C21a−C22a−C31a+C32a−C41a+C42a−C51a+C52a−C61a+C62a+C71a−C72a+C81a−C82a
+Fz1=−C11a+C12a+C21a−C22a−C31a+C32a+C41a−C42a−C51a+C52a+C61a−C62a−C71a+C72a+C81a−C82a
+Mx1=C21a−C22a−C31a+C32a−C61a+C62a+C71a−C72a
+My1=−C11a+C12a−C41a+C42a+C51a−C52a+C81a−C82a
+Mz1=−C11a+C12a−C21a+C22a−C31a+C32a−C41a+C42a−C51a+C52a−C61a+C62a−C71a+C72a−C81a+C82a
[式27]
+Fx2=C11b−C12b+C21b−C22b+C31b−C32b+C41b−C42b−C51b+C52b−C61b+C62b−C71b+C72b−C81b+C82b
+Fy2=C11b−C12b+C21b−C22b−C31b+C32b−C41b+C42b−C51b+C52b−C61b+C62b+C71b−C72b+C81b−C82b
+Fz2=−C11b+C12b+C21b−C22b−C31b+C32b+C41b−C42b−C51b+C52b+C61b−C62b−C71b+C72b+C81b−C82b
+Mx2=C21b−C22b−C31b+C32b−C61b+C62b+C71b−C72b
+My2=−C11b+C12b−C41b+C42b+C51b−C52b+C81b−C82b
+Mz2=−C11b+C12b−C21b+C22b−C31b+C32b−C41b+C42b−C51b+C52b−C61b+C62b−C71b+C72b−C81b+C82b
Then, the microcomputer 744 of the detection circuit 740 measures the acting force and the moments Fx to Mz by the following [Equation 26] and [Equation 27]. [Equation 26], in which the number at the end of the left side of each equation is "1", is based on a capacitive element having an "a" at the end, which is located relatively on the end side of the beam. On the other hand, [Equation 27], in which the number at the end of the left side of each equation is "2", is based on a capacitive element having a "b" at the end, which is located relatively inside the beam.
[Equation 26]
+ Fx1 = C11a-C12a + C21a-C22a + C31a-C32a + C41a-C42a-C51a + C52a-C61a + C62a-C71a + C72a-C81a + C82a
+ Fy1 = C11a-C12a + C21a-C22a-C31a + C32a-C41a + C42a-C51a + C52a-C61a + C62a + C71a-C72a + C81a-C82a
+ Fz1 = -C11a + C12a + C21a-C22a-C31a + C32a + C41a-C42a-C51a + C52a + C61a-C62a-C71a + C72a + C81a-C82a
+ Mx1 = C21a-C22a-C31a + C32a-C61a + C62a + C71a-C72a
+ My1 = -C11a + C12a-C41a + C42a + C51a-C52a + C81a-C82a
+ Mz1 = -C11a + C12a-C21a + C22a-C31a + C32a-C41a + C42a-C51a + C52a-C61a + C62a-C71a + C72a-C81a + C82a
[Equation 27]
+ Fx2 = C11b-C12b + C21b-C22b + C31b-C32b + C41b-C42b-C51b + C52b-C61b + C62b-C71b + C72b-C81b + C82b
+ Fy2 = C11b-C12b + C21b-C22b-C31b + C32b-C41b + C42b-C51b + C52b-C61b + C62b + C71b-C72b + C81b-C82b
+ Fz2 = -C11b + C12b + C21b-C22b-C31b + C32b + C41b-C42b-C51b + C52b + C61b-C62b-C71b + C72b + C81b-C82b
+ Mx2 = C21b-C22b-C31b + C32b-C61b + C62b + C71b-C72b
+ My2 = -C11b + C12b-C41b + C42b + C51b-C52b + C81b-C82b
+ Mz2 = -C11b + C12b-C21b + C22b-C31b + C32b-C41b + C42b-C51b + C52b-C61b + C62b-C71b + C72b-C81b + C82b

なお、力覚センサ700cの受力体760に各軸の負方向の力−Fx、−Fy、−Fzまたは各軸の負まわりのモーメント−Mx、−My、−Mzが作用した場合は、前述したように、各変位部D11〜D82のZ軸方向の変位が図42とは逆方向になる。このため、力−Fx、−Fy、−Fzまたはモーメント−Mx、−My、−Mzを検出するには、[式29]の右辺のC11〜C82の符号を全て逆にすればよい。 When the force-Fx, -Fy, -Fz in the negative direction of each axis or the negative moments -Mx, -My, -Mz of each axis act on the receiving body 760 of the force sensor 700c, the above-mentioned As described above, the displacements of the displacement portions D11 to D82 in the Z-axis direction are opposite to those in FIG. 42. Therefore, in order to detect the force -Fx, -Fy, -Fz or the moment -Mx, -My, -Mz, all the signs of C11 to C82 on the right side of [Equation 29] may be reversed.

また、本実施の形態による力覚センサ700cは、上記3−5.と同様にして他軸感度を求めると、各軸方向の力Fx、Fy、Fz及び各軸まわりのモーメントMx、My、Mzの全ての他軸感度がゼロであることが分かる。従って、図41に示す力覚センサ700cは、各軸方向の力Fx、Fy、Fz及び各軸まわりのモーメントMx、My、Mzの全てを検出することができる。 Further, the force sensor 700c according to the present embodiment is described in 3-5. When the sensitivity of the other axis is obtained in the same manner as in the above, it can be seen that all the other axis sensitivities of the forces Fx, Fy, Fz in each axial direction and the moments Mx, My, Mz around each axis are zero. Therefore, the force sensor 700c shown in FIG. 41 can detect all of the forces Fx, Fy, Fz in each axial direction and the moments Mx, My, Mz around each axis.

更に、力覚センサ700cの検出回路740は、力覚センサ700cが正常に機能しているか否かを判定する機能を有している。この判定のプロセスは、上記3−6.で説明した通りである。この場合も、このような検出回路740によれば、容量素子C11a〜C82bを構成する電極の破損、短絡、異物の混入などの異常を単一の力覚センサ700cによって検知することができる。 Further, the detection circuit 740 of the force sensor 700c has a function of determining whether or not the force sensor 700c is functioning normally. The process of this determination is described in 3-6. As explained in. In this case as well, according to such a detection circuit 740, abnormalities such as breakage, short circuit, and mixing of foreign matter in the electrodes constituting the capacitive elements C11a to C82b can be detected by a single force sensor 700c.

<<< §8. ストッパ機構を有する力覚センサ >>>
< 8−1.実施例1 >
次に、§1〜§7で説明した力覚センサが、過負荷によって故障してしまうことを回避するための工夫について説明する。
<<< §8. Force sensor with stopper mechanism >>>
<8-1. Example 1>
Next, a device for avoiding the force sensor described in §1 to §7 from being damaged due to overload will be described.

図43は、過負荷を防止するためのストッパ機構を備えた基本構造101を示す概略正面図である。基本構造101は、全体として、図1に示す基本構造100と同様の構成を有している。図43において、図1と共通する構成には同じ符号を付してある。 FIG. 43 is a schematic front view showing a basic structure 101 provided with a stopper mechanism for preventing overload. The basic structure 101 as a whole has the same structure as the basic structure 100 shown in FIG. In FIG. 43, the same reference numerals are given to the configurations common to those in FIG.

一方、基本構造101は、受力部14の下端に当接部14pが設けられ、この当接部14pと対面する支持体50の部分が、当接部14pに当接される被当接部50pとなっている点で、図1に示す基本構造100と異なる。受力部14に力が作用していないとき、当接部14pと被当接部50pとは離間している。この離間距離は、基本構造101が正常に機能する範囲を超えて、あるいは故障や破損しない範囲を超えて、受力部14がZ軸負方向に変位することを回避し得る寸法に、設定されている。 On the other hand, in the basic structure 101, a contact portion 14p is provided at the lower end of the receiving portion 14, and the portion of the support 50 facing the contact portion 14p is in contact with the contact portion 14p. It differs from the basic structure 100 shown in FIG. 1 in that it is 50p. When no force is applied to the receiving portion 14, the abutting portion 14p and the abutted portion 50p are separated from each other. This separation distance is set to a dimension that can prevent the receiving portion 14 from being displaced in the negative direction of the Z axis beyond the range in which the basic structure 101 functions normally, or beyond the range in which the basic structure 101 does not fail or break. ing.

次に、図44は、受力部14に過大なZ軸負方向の力−Fzが作用したときの、図43に示す基本構造101の変形状態を示す概略正面図である。上述した構成により、基本構造101が正常に機能する範囲を超えた過大なZ軸負方向の力−Fxが受力部14に作用すると、当接部14pを含む受力部14はZ軸負方向に変位し、やがて当接部14pが被当接部50pに当接する。これにより、当接部14pの更なるZ軸負方向への変位が規制される。この結果、変形体10に過大な負荷が伝達されないため、基本構造101が故障(破損)してしまうことが回避される。なお、受力部14に作用する力によって変形体10に生じる弾性変形、及びこの弾性変形によって変位体20に生じる変位については、§1で説明した通りである。このため、ここではその詳細な説明を省略する。 Next, FIG. 44 is a schematic front view showing a deformed state of the basic structure 101 shown in FIG. 43 when an excessive force −Fz in the negative direction of the Z axis acts on the receiving portion 14. With the above configuration, when an excessive force in the negative Z-axis direction-Fx, which exceeds the range in which the basic structure 101 functions normally, acts on the receiving portion 14, the receiving portion 14 including the contact portion 14p is negative in the Z-axis. It is displaced in the direction, and eventually the contact portion 14p comes into contact with the contacted portion 50p. As a result, further displacement of the contact portion 14p in the negative Z-axis direction is regulated. As a result, since an excessive load is not transmitted to the deformed body 10, it is possible to prevent the basic structure 101 from failing (damaged). The elastic deformation caused by the force acting on the receiving portion 14 on the deformed body 10 and the displacement caused by the elastic deformation on the displaced body 20 are as described in §1. Therefore, the detailed description thereof will be omitted here.

以上のような基本構造101によれば、Z軸負方向に過大な力−Fzが作用しても、当接部14pと被当接部50pとの離間距離が所定の値以下であるため、受力部14のZ軸負方向への変位が所定の範囲内に制限される。このため、過負荷によって故障しにくい基本構造101を実現することができる。更に、この基本構造101を採用して力覚センサを構成すれば、過負荷によって故障しにくい力覚センサを実現することができる。 According to the basic structure 101 as described above, even if an excessive force −Fz acts in the negative direction of the Z axis, the separation distance between the contact portion 14p and the contacted portion 50p is equal to or less than a predetermined value. The displacement of the receiving unit 14 in the negative direction of the Z axis is limited within a predetermined range. Therefore, it is possible to realize the basic structure 101 which is less likely to break down due to overload. Further, if the force sensor is configured by adopting this basic structure 101, it is possible to realize a force sensor that is less likely to fail due to overload.

なお、図43では、当接部14pと被当接部50pとの離間距離を所定の値以下とするため、図1に示す基本構造100において、受力部14の下端を下方に延長することによって当接部14pを構成した。しかしながら、これとは逆に、支持体50のうち受力部14に対面する部分を上方に突出させて被当接部50pを構成することで、当接部14pと被当接部50pとの離間距離を所定の値以下として良い。この場合も、過負荷によって故障しにくい基本構造を実現することができる。 In FIG. 43, in order to keep the distance between the abutting portion 14p and the abutted portion 50p to a predetermined value or less, in the basic structure 100 shown in FIG. 1, the lower end of the receiving portion 14 is extended downward. The contact portion 14p was formed by the above. However, on the contrary, the contacted portion 14p and the contacted portion 50p are formed by projecting the portion of the support 50 facing the receiving portion 14 upward to form the contacted portion 50p. The separation distance may be set to a predetermined value or less. In this case as well, it is possible to realize a basic structure that is less likely to break down due to overload.

このようなストッパ機構を備えた基本構造101は、もちろん、上述した故障診断機能を有する力覚センサとして構成することも可能である。この場合、故障診断の方法は、§1で説明した通りであるため、ここでは繰り返しの説明は省略する。このことは、後述する各実施例においても同様である。 Of course, the basic structure 101 provided with such a stopper mechanism can also be configured as a force sensor having the above-mentioned failure diagnosis function. In this case, since the method of failure diagnosis is as described in §1, the repeated description is omitted here. This also applies to each of the examples described later.

< 8−2.実施例2 >
次に、図45〜図50を参照して、ストッパ機構の他の実施例について説明する。
<8-2. Example 2>
Next, another embodiment of the stopper mechanism will be described with reference to FIGS. 45 to 50.

図45は、他の例による過負荷を防止するためのストッパ機構を備えた基本構造102を示す概略正面図であり、図46は、図45の概略平面図である。 FIG. 45 is a schematic front view showing a basic structure 102 provided with a stopper mechanism for preventing overload according to another example, and FIG. 46 is a schematic plan view of FIG. 45.

図45及び図46に示すように、基本構造102は、全体として、図1及び図2に示す基本構造100と同様の構成を有している。図45及び図46において、図1と共通する構成には同じ符号を付してある。 As shown in FIGS. 45 and 46, the basic structure 102 as a whole has the same structure as the basic structure 100 shown in FIGS. 1 and 2. In FIGS. 45 and 46, the same reference numerals are given to the configurations common to those in FIG.

但し、基本構造102は、受力部14のX軸正側の側面及びX軸負側の側面に、Y軸方向に沿って延在する一対の凹部14aが形成されている。更に、基本構造102は、変形体10の固定部15、または支持体50に接続された一対のストッパ70を有している。詳細には図示されていないが、このストッパ70は、変形体10及び変位体20に干渉することなく、受力部14の近位まで延びている支持部により支持されている。一対のストッパ70は、Y軸方向から見て同一の形状を有しており、互いに同一のZ座標を有している。 However, in the basic structure 102, a pair of recesses 14a extending along the Y-axis direction are formed on the side surface on the positive side of the X-axis and the side surface on the negative side of the X-axis of the receiving portion 14. Further, the basic structure 102 has a fixed portion 15 of the deformed body 10 or a pair of stoppers 70 connected to the support 50. Although not shown in detail, the stopper 70 is supported by a support portion extending proximally to the receiving portion 14 without interfering with the deformed body 10 and the displacement body 20. The pair of stoppers 70 have the same shape when viewed from the Y-axis direction, and have the same Z coordinates as each other.

図46に示すように、ストッパ70は、少なくとも一部が一対の凹部14a内に位置している。ストッパ70は、固定部15及び支持体50に対して変位しない。このため、当該ストッパ70と凹部14aの上面(Z軸負方向を向いた面)との離間距離は、受力部14に許容されるZ軸負方向への変位を規定し、当該ストッパ70と凹部14aの下面(Z軸正方向を向いた面)との離間距離は、受力部14に許容されるZ軸正方向への変位を規定している。更に、一対のストッパ70のうちX軸負側のストッパを70L、X軸正側のストッパを70Rとする。このとき、ストッパ70Lと凹部14aの側面(X軸負方向を向いた面)との離間距離は、受力部14に許容されるX軸負方向への変位を規定し、ストッパ70Rと凹部14aの側面(X軸正方向を向いた面)との離間距離は、受力部14に許容されるX軸正方向への変位を規定している。このように、一対のストッパ70は、受力部14の固定部15に対するX軸方向及びZ軸方向への相対移動を、所定の範囲に制限するようになっている。 As shown in FIG. 46, at least a part of the stopper 70 is located in the pair of recesses 14a. The stopper 70 does not displace with respect to the fixing portion 15 and the support 50. Therefore, the separation distance between the stopper 70 and the upper surface of the recess 14a (the surface facing the negative direction of the Z axis) defines the displacement of the receiving portion 14 in the negative direction of the Z axis, and the stopper 70 and the stopper 70 are separated from each other. The distance between the recess 14a and the lower surface (the surface facing the Z-axis positive direction) defines the displacement of the receiving portion 14 in the Z-axis positive direction. Further, of the pair of stoppers 70, the stopper on the negative side of the X-axis is 70L, and the stopper on the positive side of the X-axis is 70R. At this time, the separation distance between the stopper 70L and the side surface of the recess 14a (the surface facing the negative direction of the X-axis) defines the displacement of the receiving portion 14 in the negative direction of the X-axis, and the stopper 70R and the recess 14a are separated. The distance from the side surface (the surface facing the positive direction of the X-axis) defines the displacement of the receiving portion 14 in the positive direction of the X-axis. As described above, the pair of stoppers 70 limits the relative movement of the receiving portion 14 with respect to the fixed portion 15 in the X-axis direction and the Z-axis direction within a predetermined range.

次に、図47は、受力部14に過大なX軸正方向の力+Fxが作用したときの、基本構造102の変形状態を示す概略正面図であり、図48は、受力部14に過大なX軸負方向の力−Fxが作用したときの、基本構造102の変形状態を示す概略正面図である。また、図49は、受力部14に過大なZ軸負方向の力−Fzが作用したときの基本構造102の変形状態を示す概略正面図であり、図50は、受力部14に過大なZ軸正方向の力+Fzが作用したときの、基本構造102の変形状態を示す概略正面図である。 Next, FIG. 47 is a schematic front view showing a deformed state of the basic structure 102 when an excessive force + Fx in the positive direction of the X axis is applied to the receiving portion 14, and FIG. 48 is a schematic front view showing the deformed state of the basic structure 102. FIG. 48 is a schematic front view showing the receiving portion 14. It is a schematic front view which shows the deformed state of the basic structure 102 when an excessive force-Fx in the negative direction of the X axis is applied. Further, FIG. 49 is a schematic front view showing a deformed state of the basic structure 102 when an excessive force −Fz in the negative direction of the Z axis is applied to the receiving portion 14, and FIG. 50 is an excessive front view showing the deformed state of the receiving portion 14. It is a schematic front view which shows the deformed state of the basic structure 102 when a force + Fz in the positive direction of the Z axis is applied.

上述した構成により、基本構造102が正常に機能する範囲を超えた過大なX軸正方向の力+Fxが受力部14に作用すると、受力部14はX軸正方向に変位し、やがて受力部14がストッパ70Rに当接する。これにより、受力部14の更なるX軸正方向への変位が規制される(図47参照)。更に、基本構造102が正常に機能する範囲を超えた過大なX軸負方向の力−Fxが受力部14に作用すると、受力部14はX軸負方向に変位し、やがて受力部14がストッパ70Lに当接する。これにより、受力部14の更なるX軸負方向への変位が規制される(図48参照)。以上から、過大な力が受力部14にX軸正方向に作用してもX軸負方向に作用しても、基本構造102の故障(破損)が回避される。 With the above configuration, when an excessive force in the positive direction of the X-axis + Fx, which exceeds the range in which the basic structure 102 functions normally, acts on the receiving portion 14, the receiving portion 14 is displaced in the positive direction of the X-axis and eventually receives. The force portion 14 comes into contact with the stopper 70R. As a result, further displacement of the receiving unit 14 in the positive direction of the X-axis is restricted (see FIG. 47). Further, when an excessive force in the negative direction of the X-axis-Fx, which exceeds the range in which the basic structure 102 functions normally, acts on the receiving portion 14, the receiving portion 14 is displaced in the negative direction of the X-axis, and eventually the receiving portion 14 comes into contact with the stopper 70L. As a result, further displacement of the receiving unit 14 in the negative direction of the X-axis is regulated (see FIG. 48). From the above, failure (damage) of the basic structure 102 can be avoided regardless of whether an excessive force acts on the receiving portion 14 in the positive direction of the X-axis or in the negative direction of the X-axis.

更に、基本構造102が正常に機能する範囲を超えた過大なZ軸正方向の力+Fzが受力部14に作用すると、受力部14はZ軸正方向に変位し、やがて受力部14が一対のストッパ70に当接する。これにより、受力部14の更なるZ軸正方向への変位が規制される(図50参照)。更に、基本構造102が正常に機能する範囲を超えた過大なZ軸負方向の力−Fzが受力部14に作用すると、受力部14はZ軸負方向に変位し、やがて受力部14が一対のストッパ70に当接する。これにより、受力部14の更なるZ軸負方向への変位が規制される(図49参照)。以上から、過大な力が受力部14にZ軸正方向に作用してもZ軸負方向に作用しても、基本構造102の故障(破損)が回避される。なお、受力部14に作用する力によって変形体10に生じる弾性変形、及びこの弾性変形によって変位体20に生じる変位については、§1で説明した通りである。このため、ここではその詳細な説明を省略する。 Further, when an excessive force in the positive direction of the Z axis + Fz, which exceeds the range in which the basic structure 102 functions normally, acts on the receiving portion 14, the receiving portion 14 is displaced in the positive direction of the Z axis, and eventually the receiving portion 14 Abuts on the pair of stoppers 70. As a result, further displacement of the receiving portion 14 in the positive direction of the Z axis is regulated (see FIG. 50). Further, when an excessive force in the negative direction of the Z axis −Fz, which exceeds the range in which the basic structure 102 functions normally, acts on the receiving portion 14, the receiving portion 14 is displaced in the negative direction of the Z axis, and eventually the receiving portion 14 comes into contact with the pair of stoppers 70. As a result, further displacement of the receiving portion 14 in the negative direction of the Z axis is regulated (see FIG. 49). From the above, failure (damage) of the basic structure 102 can be avoided regardless of whether an excessive force acts on the receiving portion 14 in the positive direction of the Z axis or in the negative direction of the Z axis. The elastic deformation caused by the force acting on the receiving portion 14 on the deformed body 10 and the displacement caused by the elastic deformation on the displaced body 20 are as described in §1. Therefore, the detailed description thereof will be omitted here.

以上のような基本構造102によれば、X軸方向及びZ軸負方向に過大な力Fx、Fzが作用しても、一対のストッパ70の存在によって、受力部14のZ軸及びZ軸負方向への変位が所定の範囲内に制限される。このため、過負荷によって故障しにくい基本構造102を実現することができる。更に、この基本構造102を採用して力覚センサを構成すれば、過負荷によって故障しにくい力覚センサを実現することができる。 According to the basic structure 102 as described above, even if excessive forces Fx and Fz act in the X-axis direction and the Z-axis negative direction, the presence of the pair of stoppers 70 causes the Z-axis and Z-axis of the receiving portion 14 to act. Negative displacement is limited to a predetermined range. Therefore, it is possible to realize the basic structure 102 that is less likely to break down due to overload. Further, if the force sensor is configured by adopting this basic structure 102, it is possible to realize a force sensor that is less likely to fail due to overload.

< 8−3.実施例3 >
次に、図51〜図57を参照して、ストッパ機構の更に他の実施例について説明する。
<8-3. Example 3>
Next, still another embodiment of the stopper mechanism will be described with reference to FIGS. 51 to 57.

図51は、更に他の例による過負荷を防止するためのストッパ機構を備えた基本構造103を示す概略正面図であり、図52はその概略平面図である。 FIG. 51 is a schematic front view showing a basic structure 103 provided with a stopper mechanism for preventing overload according to still another example, and FIG. 52 is a schematic plan view thereof.

図51及び図52に示すように、基本構造103は、全体として、図1に示す基本構造100と同様の構成を有している。図51及び図52において、図1及び図2と共通する構成には同じ符号を付してある。 As shown in FIGS. 51 and 52, the basic structure 103 as a whole has the same structure as the basic structure 100 shown in FIG. In FIGS. 51 and 52, the same reference numerals are given to the configurations common to those in FIGS. 1 and 2.

図51及び図52に示すように、基本構造103は、受力部14にY軸方向と平行に延在する貫通孔14bが設けられている。貫通孔14bは、Y軸と平行な中心軸線を有する円筒の形状を有している。更に、基本構造103は、変形体10の固定部15に接続されたストッパ71を有している。詳細には図示されていないが、このストッパ71は、変形体10及び変位体20に干渉することなく、受力部14の近位まで延びている支持部により支持されている。ストッパ71は、Y軸と平行に延びる中心軸線を有する円柱の形状を有している。 As shown in FIGS. 51 and 52, the basic structure 103 is provided with a through hole 14b extending in parallel with the Y-axis direction in the receiving portion 14. The through hole 14b has a cylindrical shape having a central axis parallel to the Y axis. Further, the basic structure 103 has a stopper 71 connected to the fixing portion 15 of the deformed body 10. Although not shown in detail, the stopper 71 is supported by a support portion extending proximally to the receiving portion 14 without interfering with the deformed body 10 and the displaced body 20. The stopper 71 has the shape of a cylinder having a central axis extending parallel to the Y axis.

図51および図52に示すように、ストッパ71は、少なくとも一部が受力部14の貫通孔14b内に同心に位置している。ストッパ71は、固定部15及び支持体50に対して変位しない。このため、当該ストッパ71の半径と貫通孔14bの半径との差は、受力部14に許容されるXZ平面内における変位を規定している。このような構成により、ストッパ71は、受力部14の固定部15に対するX軸方向及びZ軸方向への相対移動を、所定の範囲に制限するようになっている。 As shown in FIGS. 51 and 52, at least a part of the stopper 71 is concentrically located in the through hole 14b of the receiving portion 14. The stopper 71 does not displace with respect to the fixing portion 15 and the support 50. Therefore, the difference between the radius of the stopper 71 and the radius of the through hole 14b defines the displacement in the XZ plane allowed for the receiving portion 14. With such a configuration, the stopper 71 limits the relative movement of the receiving portion 14 with respect to the fixed portion 15 in the X-axis direction and the Z-axis direction within a predetermined range.

次に、図53は、受力部14に過大なX軸正方向の力+Fxが作用したときの、基本構造103の変形状態を示す概略正面図であり、図54は、受力部14に過大なX軸負方向の力−Fxが作用したときの、基本構造103の変形状態を示す概略正面図である。また、図55は、受力部14に過大なZ軸負方向の力−Fzが作用したときの基本構造103の変形状態を示す概略正面図であり、図56は、受力部14に過大なZ軸正方向の力+Fzが作用したときの、基本構造103の変形状態を示す概略正面図である。 Next, FIG. 53 is a schematic front view showing a deformed state of the basic structure 103 when an excessive force in the positive direction of the X-axis + Fx is applied to the receiving portion 14, and FIG. 54 is a schematic front view showing the deformed state of the basic structure 103. FIG. 54 is a schematic front view showing the receiving portion 14. It is a schematic front view which shows the deformation state of the basic structure 103 when an excessive force-Fx in the negative direction of the X axis is applied. Further, FIG. 55 is a schematic front view showing a deformed state of the basic structure 103 when an excessive force −Fz in the negative direction of the Z axis is applied to the receiving portion 14, and FIG. 56 is an excessive front view showing the deformed state of the receiving portion 14. It is a schematic front view which shows the deformed state of the basic structure 103 when a force + Fz in the positive direction of the Z axis is applied.

上述した構成により、図53〜図56に示すように、基本構造103が正常に機能する範囲を超えた過大なX軸及びZ軸方向の力Fx、Fzが受力部14に作用すると、受力部14はXZ平面内で変位し、やがて受力部14がストッパ71に当接する。これにより、受力部14の更なるXZ平面内における変位が規制される。このように、過大なX軸及びZ軸方向の力Fx、Fzが受力部14に作用しても、基本構造103の故障(破損)が回避される。なお、受力部14に作用する力によって変形体10に生じる弾性変形、及びこの弾性変形によって変位体20に生じる変位については、§1で説明した通りである。このため、ここではその詳細な説明を省略する。 With the above configuration, as shown in FIGS. 53 to 56, when excessive forces Fx and Fz in the X-axis and Z-axis directions beyond the range in which the basic structure 103 functions normally act on the receiving portion 14, the receiving portion 14 is received. The force portion 14 is displaced in the XZ plane, and the force receiving portion 14 eventually comes into contact with the stopper 71. As a result, the displacement of the receiving portion 14 in the further XZ plane is regulated. In this way, even if excessive forces Fx and Fz in the X-axis and Z-axis directions act on the receiving portion 14, failure (damage) of the basic structure 103 is avoided. The elastic deformation caused by the force acting on the receiving portion 14 on the deformed body 10 and the displacement caused by the elastic deformation on the displaced body 20 are as described in §1. Therefore, the detailed description thereof will be omitted here.

以上のような基本構造103によれば、X軸方向及びZ軸負方向に過大な力Fx、Fzが作用しても、ストッパ71の存在によって、受力部14のX軸及びZ軸負方向への変位が所定の範囲内に制限される。このため、過負荷によって故障しにくい基本構造103を実現することができる。更に、この基本構造103を採用して力覚センサを構成すれば、過負荷によって故障しにくい力覚センサを実現することができる。 According to the basic structure 103 as described above, even if excessive forces Fx and Fz act in the X-axis direction and the Z-axis negative direction, the presence of the stopper 71 causes the X-axis and Z-axis negative directions of the receiving portion 14. The displacement to is limited to a predetermined range. Therefore, it is possible to realize the basic structure 103 that is less likely to break down due to overload. Further, if the force sensor is configured by adopting this basic structure 103, it is possible to realize a force sensor that is less likely to fail due to overload.

< 8−4.変形例 >
次に、図57は、図43の変形例による基本構造104を示す概略正面図である。図43に示す基本構造101では、当接部14p及び被当接部50pが共にXY平面と平行な面として規定されていた。このため、受力部14に過大なX軸方向の力Fxが作用した際には、受力部14の変位が所定の範囲内に制限されない。これに対し、図57に示す基本構造104では、受力部14の当接部14gが凹部を有し、当接部14pに当接される被当接部50gが凸部を有している。当接部14gの凹部と被当接部50gの凸部とのX軸方向及びZ軸方向の各離間距離は、基本構造104が正常に機能する範囲を超えて、あるいは故障や破損しない範囲を超えて、受力部14がX軸方向及びZ軸負方向に変位することを回避し得る寸法に、設定されている。なお、図57では、当接部14gの凹部及び被当接部50gの凸部が、Z軸正方向に湾曲した湾曲面として示されているが、このような態様には限定されない。他の例としては、当接部14gの凹部及び被当接部50gの凸部として、Y軸方向から観察して矩形の断面形状を有する凹部及び凸部が採用され得る。
<8-4. Modification example >
Next, FIG. 57 is a schematic front view showing the basic structure 104 according to the modified example of FIG. 43. In the basic structure 101 shown in FIG. 43, both the abutting portion 14p and the abutted portion 50p are defined as planes parallel to the XY plane. Therefore, when an excessive force Fx in the X-axis direction acts on the receiving portion 14, the displacement of the receiving portion 14 is not limited within a predetermined range. On the other hand, in the basic structure 104 shown in FIG. 57, the abutting portion 14g of the receiving portion 14 has a concave portion, and the abutted portion 50g abutting on the abutting portion 14p has a convex portion. .. The distance between the concave portion of the abutting portion 14g and the convex portion of the abutted portion 50g in the X-axis direction and the Z-axis direction exceeds the range in which the basic structure 104 functions normally, or the range in which the basic structure 104 does not fail or be damaged. The size is set so that the receiving portion 14 can be prevented from being displaced in the X-axis direction and the Z-axis negative direction. In FIG. 57, the concave portion of the abutting portion 14g and the convex portion of the abutted portion 50g are shown as curved surfaces curved in the positive direction of the Z axis, but the present invention is not limited to this aspect. As another example, as the concave portion of the contact portion 14 g and the convex portion of the contacted portion 50 g, a concave portion and a convex portion having a rectangular cross-sectional shape when observed from the Y-axis direction can be adopted.

このような構成によれば、過大なZ軸負方向の力−Fzが作用した場合のみならず、過大なX軸方向の力Fxが作用した場合にも、受力部14のX軸方向の変位を所定の範囲内に制限することができる。これにより、過負荷によって故障しにくい基本構造104を実現することができる。更に、この基本構造104を採用して力覚センサを構成すれば、過負荷によって故障しにくい力覚センサを実現することができる。 According to such a configuration, not only when an excessive force in the negative Z-axis direction −Fz is applied, but also when an excessive force Fx in the X-axis direction is applied, the force receiving portion 14 is in the X-axis direction. The displacement can be limited within a predetermined range. As a result, it is possible to realize a basic structure 104 that is less likely to break down due to overload. Further, if the force sensor is configured by adopting this basic structure 104, it is possible to realize a force sensor that is less likely to fail due to overload.

更に、図示は省略するが、被当接部50gを、例えばX軸方向に延在するロッド部を有するL字またはT字の形状に構成し、当接部14gを、当該L字またはT字の形状のロッド部によって貫通されるように構成することも考えられる。要するに、支持体50がストッパの機能をも提供するように構成されている。この場合、過大なZ軸正方向の力+Fzが作用しても故障が生じにくい基本構造104を実現することができる。 Further, although not shown, the contacted portion 50 g is formed in an L-shaped or T-shaped shape having a rod portion extending in the X-axis direction, and the contacted portion 14 g is formed in the L-shaped or T-shaped portion. It is also conceivable to configure it so that it is penetrated by a rod portion having the shape of. In short, the support 50 is configured to also provide the function of a stopper. In this case, it is possible to realize the basic structure 104 in which failure is unlikely to occur even if an excessive force in the positive direction of the Z axis + Fz acts.

なお、以上の8−1〜8−4で示したストッパ機構は、§1に示す基本構造100及び力覚センサ100cに限らず、§2〜§7に示す各基本構造200〜700及び力覚センサ200c〜700cにも採用され得る。すなわち、§2〜§7に示す各基本構造200〜700は、§1に示す基本構造100を2つ、4つあるいは8つ組み合わせて構成されていると捉えることができる。このため、各基本構造200〜700のうち、§1に示す基本構造100に対応する構成部分の少なくとも1つに、好ましくは全てに、上述したストッパ機構のいずれかを採用すればよい。この場合、§2〜§7に示す各基本構造200〜700及び力覚センサ200c〜700cに過大な力及び/またはモーメントが作用しても、当該基本構造200〜700及び力覚センサ200c〜700cに故障や破損が生じることを抑制することができる。 The stopper mechanism shown in 8-1 to 8-4 is not limited to the basic structure 100 and the force sensor 100c shown in §1, but the basic structures 200 to 700 and the force sensor shown in §2 to §7. It can also be used for sensors 200c to 700c. That is, each of the basic structures 200 to 700 shown in §2 to §7 can be regarded as being composed of a combination of two, four, or eight basic structures 100 shown in §1. Therefore, one of the above-mentioned stopper mechanisms may be adopted for at least one of the constituent parts corresponding to the basic structure 100 shown in §1 among the basic structures 200 to 700, preferably for all of them. In this case, even if an excessive force and / or moment acts on the basic structures 200 to 700 and the force sensors 200c to 700c shown in §2 to §7, the basic structures 200 to 700 and the force sensors 200c to 700c. It is possible to suppress the occurrence of failure or damage to the sensor.

Claims (8)

作用する力を受けるための受力体と、
XYZ三次元座標系におけるZ軸方向において前記受力体の一側に配置された支持体と、
前記受力体と前記支持体との間に配置された傾動部と、
前記受力体と前記傾動部とを接続し、前記受力体に作用した力により弾性変形を生じる第1変形部と、
前記支持体と前記傾動部とを接続し、前記受力体に作用した力により弾性変形を生じる第2変形部と、
前記傾動部に接続され、前記第1変形部および前記第2変形部に生じる弾性変形により変位を生じる変位体と、
前記変位体に生じる変位に基づいて、作用した力を検出する検出回路と、を備え
記第1変形部と前記傾動部との接続部位と、前記第2変形部と前記傾動部との接続部位とは、前Z軸方向において位置が異なっており、
前記変位体は、前記傾動部に接続されているが前記支持体から離間する、当該傾動部の傾動によって変位する変位部を有し、
前記検出回路は、前記変位部に配置された第1変位センサ及び第2変位センサを有し、
前記検出回路は、前記第1変位センサの検出値に基づいて、作用した力を示す第1電気信号を出力し、且つ、前記第2変位センサの検出値に基づいて、作用した力を示す第2電気信号を出力し、当該第1電気信号及び当該第2電気信号に基づいて、力の検出が正常に行われているか否かを判定する、力覚センサ。
A receiving body to receive the acting force and
A support arranged on one side of the receiving body in the Z-axis direction in the XYZ three-dimensional coordinate system, and
A tilting portion arranged between the receiving body and the supporting body,
A first deformed portion that connects the receiving body and the tilting portion and causes elastic deformation by the force acting on the receiving body, and a first deformed portion.
A second deformed portion that connects the support and the tilted portion and causes elastic deformation due to a force acting on the receiving body, and a second deformed portion.
A displacement body that is connected to the tilting portion and causes displacement due to elastic deformation that occurs in the first deformed portion and the second deformed portion.
A detection circuit that detects the applied force based on the displacement generated in the displacement body is provided .
A connection portion between front Symbol the tilting part and the first deformation portion, wherein a connection portion between the second deformable portion and the tilting part, has different positions in front Symbol Z-axis direction,
The displacement body has a displacement portion that is connected to the tilting portion but is separated from the support and is displaced by the tilting of the tilting portion .
The detection circuit has a first displacement sensor and a second displacement sensor arranged in the displacement portion.
The detection circuit outputs a first electric signal indicating the applied force based on the detected value of the first displacement sensor, and indicates the applied force based on the detected value of the second displacement sensor. 2 A force sensor that outputs an electric signal and determines whether or not force detection is normally performed based on the first electric signal and the second electric signal.
前記検出回路は、前記第1電気信号と前記第2電気信号との和である合算電気信号を出力し、
前記検出回路は、前記合算電気信号と、前記第1電気信号及び前記第2電気信号の少なくとも一方と、に基づいて、力の検出が正常に行われているか否かを判定する、請求項1に記載の力覚センサ。
The detection circuit outputs a total electric signal which is the sum of the first electric signal and the second electric signal.
The detection circuit determines whether or not force detection is normally performed based on the total electric signal and at least one of the first electric signal and the second electric signal. The force sensor described in.
前記支持体は、前記変位体に対向配置され、
各変位センサは、前記変位体の前記変位部に配置された変位電極と、この変位電極に対向して前記支持体上に配置された固定電極と、を有する容量素子である、請求項1または2に記載の力覚センサ。
The support is arranged so as to face the displacement body .
Each displacement sensor is a capacitive element having a displacement electrode arranged in the displacement portion of the displacement body and a fixed electrode arranged on the support so as to face the displacement electrode. 2. The force sensor according to 2.
前記変位部は、前Z軸方向と交差する方向に延在する梁を有する、請求項1〜3のいずれか一項に記載の力覚センサ。 The displacement unit includes a beam that extends in a direction crossing the front Symbol Z-axis direction, the force sensor according to any one of claims 1 to 3. 前記梁には、第1計測部位が規定され、
前記検出回路は、前記第1計測部位の変位を計測する、第1−1変位センサ及び第1−2変位センサを有し、
前記検出回路は、前記第1−1変位センサの検出値に基づいて前記第1電気信号を出力し、且つ、前記第1−2変位センサの検出値に基づいて前記第2電気信号を出力する、請求項4に記載の力覚センサ。
A first measurement site is defined on the beam,
The detection circuit has a 1-1 displacement sensor and a 1-2 displacement sensor that measure the displacement of the first measurement site.
The detection circuit outputs the first electric signal based on the detection value of the 1-1 displacement sensor, and outputs the second electric signal based on the detection value of the 1-2 displacement sensor. , The force sensor according to claim 4.
前記梁には、第1計測部位及び第2計測部位が規定され、
前記検出回路は、前記第1計測部位の変位を計測する、第1−1変位センサ及び第1−2変位センサと、前記第2計測部位の変位を計測する、第2−1変位センサ及び第2−2変位センサと、を有し、
前記検出回路は、前記第1−1変位センサ及び前記第1−2変位センサの各検出値に基づいて前記第1電気信号を出力し、且つ、前記第2−1変位センサ及び前記第2−2変位センサの各検出値に基づいて前記第2電気信号を出力する、請求項4に記載の力覚センサ。
A first measurement part and a second measurement part are defined on the beam, and the beam has a first measurement part and a second measurement part.
The detection circuit has a 1-1 displacement sensor and a 1-2 displacement sensor that measure the displacement of the first measurement site, and a 2-1 displacement sensor and a second displacement sensor that measure the displacement of the second measurement site. Has a 2-2 displacement sensor,
The detection circuit outputs the first electric signal based on the detected values of the 1-1 displacement sensor and the 1-2 displacement sensor, and also outputs the 2-1 displacement sensor and the 2-. 2. The force sensor according to claim 4, which outputs the second electric signal based on each detected value of the displacement sensor.
前記変位部は、前記傾動部と前記梁とを接続する接続体を有し、
前記変位体の前記第1計測部位及び前記第2計測部位は、前記接続体と前記梁との接続部位に関して対称的に規定され、
前記検出回路は、前記第1−1変位センサの検出値と前記第2−2変位センサの検出値との差に基づいて前記第1電気信号を出力し、且つ、前記第1−2変位センサの検出値と前記第2−1変位センサの検出値との差に基づいて前記第2電気信号を出力する、請求項6に記載の力覚センサ。
The displacement portion includes a connection member for connecting the the front Symbol tilt part beam,
The first measurement portion and the second measurement portion of the displacement body are symmetrically defined with respect to the connection portion between the connection body and the beam.
The detection circuit outputs the first electric signal based on the difference between the detection value of the 1-1 displacement sensor and the detection value of the 2-2 displacement sensor, and the 1-2 displacement sensor. The force sensor according to claim 6, wherein the second electric signal is output based on the difference between the detected value of the 2-1 displacement sensor and the detected value of the 2-1 displacement sensor.
前記検出回路は、前記第1電気信号、または、前記第1電気信号と前記第2電気信号との和である合算電気信号、に基づいて作用した力を検出する、請求項1〜7のいずれか一項に記載の力覚センサ。 The detection circuit is any of claims 1 to 7, wherein the detection circuit detects a force acting based on the first electric signal or the total electric signal which is the sum of the first electric signal and the second electric signal. The force sensor described in item 1.
JP2019176114A 2018-01-09 2019-09-26 Force sensor Active JP6925653B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019176114A JP6925653B2 (en) 2018-01-09 2019-09-26 Force sensor

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2018512355A JP6617251B1 (en) 2018-01-09 2018-01-09 Force sensor
JP2019176114A JP6925653B2 (en) 2018-01-09 2019-09-26 Force sensor

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2018512355A Division JP6617251B1 (en) 2018-01-09 2018-01-09 Force sensor

Publications (3)

Publication Number Publication Date
JP2020012844A JP2020012844A (en) 2020-01-23
JP2020012844A5 JP2020012844A5 (en) 2020-10-22
JP6925653B2 true JP6925653B2 (en) 2021-08-25

Family

ID=69170955

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019176114A Active JP6925653B2 (en) 2018-01-09 2019-09-26 Force sensor

Country Status (1)

Country Link
JP (1) JP6925653B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021135284A (en) * 2020-08-19 2021-09-13 株式会社トライフォース・マネジメント Force sensor

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7323970B1 (en) * 2022-11-04 2023-08-09 株式会社トライフォース・マネジメント torque sensor
CN116026510A (en) * 2023-01-03 2023-04-28 钛玛科(北京)工业科技有限公司 A Method of Calculating the Output Value of Tension Meter Based on Proportional Value Algorithm

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05215627A (en) * 1992-02-04 1993-08-24 Kazuhiro Okada Device for detecting force, acceleration, and magnetism in multidimensional direction
JP5836633B2 (en) * 2011-05-10 2015-12-24 キヤノン株式会社 Force sensor and assembly robot
JP5714648B2 (en) * 2012-11-16 2015-05-07 株式会社豊田中央研究所 Mechanical quantity MEMS sensor and mechanical quantity MEMS sensor system
EP3155389B1 (en) * 2014-06-11 2019-05-08 EILERSEN, Nils Aage Juul Load cell having an elastic body
JP6265430B2 (en) * 2014-09-01 2018-01-24 日本リニアックス株式会社 Multi-axis sensor and method of manufacturing multi-axis sensor
JP5911936B1 (en) * 2014-09-30 2016-04-27 ファナック株式会社 Displacement detection type 6-axis force sensor
JP6002868B1 (en) * 2015-04-07 2016-10-05 株式会社トライフォース・マネジメント Force sensor and structure used therefor
JP6864682B2 (en) * 2015-12-07 2021-04-28 オー ユール アイラーセン,ニールス Load cell
JP6241982B1 (en) * 2016-08-31 2017-12-06 株式会社トライフォース・マネジメント Force sensor

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021135284A (en) * 2020-08-19 2021-09-13 株式会社トライフォース・マネジメント Force sensor
JP7160375B2 (en) 2020-08-19 2022-10-25 株式会社トライフォース・マネジメント force sensor

Also Published As

Publication number Publication date
JP2020012844A (en) 2020-01-23

Similar Documents

Publication Publication Date Title
JP6617251B1 (en) Force sensor
JP6925653B2 (en) Force sensor
JP6308605B1 (en) Force sensor
JP6241982B1 (en) Force sensor
JP6600824B2 (en) Force sensor
US20070095156A1 (en) Flexure system for strain-based instruments
JP6644307B2 (en) Force sensor
JP6257017B1 (en) Force sensor
JP6685568B2 (en) Force sensor
CN1126839A (en) Micromachined accelerometer with improved detection circuit
JP2018146584A (en) Kinesthetic sensor
JP7055501B2 (en) Force sensor
JP6804122B2 (en) Force sensor
JP2010014695A (en) Multiaxial sensor
US11913849B2 (en) Multi-degree of freedom force and torque sensor and robot
CN111829714B (en) Multi-degree-of-freedom force and moment sensor and robot
JP6804091B2 (en) Force sensor
JP6893717B2 (en) Force sensor
TW202240170A (en) Inertial sensor
CN118190205A (en) Non-contact torque sensor and robot
JP2023056281A (en) Calibration system and calibration method

Legal Events

Date Code Title Description
A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200911

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200911

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

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20210630

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210728

R150 Certificate of patent or registration of utility model

Ref document number: 6925653

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150