JP2012045204A - Article holding device and prize obtaining game apparatus - Google Patents

Article holding device and prize obtaining game apparatus Download PDF

Info

Publication number
JP2012045204A
JP2012045204A JP2010190871A JP2010190871A JP2012045204A JP 2012045204 A JP2012045204 A JP 2012045204A JP 2010190871 A JP2010190871 A JP 2010190871A JP 2010190871 A JP2010190871 A JP 2010190871A JP 2012045204 A JP2012045204 A JP 2012045204A
Authority
JP
Japan
Prior art keywords
arm
unit
drive mechanism
shaft
object gripping
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2010190871A
Other languages
Japanese (ja)
Other versions
JP5786293B2 (en
Inventor
Hideki Watanabe
英樹 渡辺
Koki Takasugi
耕起 高杉
Akihiro Mori
晶洋 森
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.)
Sega Corp
Original Assignee
Sega 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
Application filed by Sega Corp filed Critical Sega Corp
Priority to JP2010190871A priority Critical patent/JP5786293B2/en
Publication of JP2012045204A publication Critical patent/JP2012045204A/en
Application granted granted Critical
Publication of JP5786293B2 publication Critical patent/JP5786293B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

PROBLEM TO BE SOLVED: To use a motor at lower cost than a conventional one to obtain holding force that is weaker than that generated by self-weight of an arm.SOLUTION: The article holding device includes: an arm 8 attachable to a movable base and holding an article; a driving mechanism 70 corresponding to the arm 8; a resilient body 73 connecting between the arm 8 and the driving mechanism 70; an arm shaft position detecting part 74 for detecting the position of an arm shaft 82a when the arm 8 turns; a driving mechanism position detecting part 72 for detecting the position of an output shaft 75a of the driving mechanism 70; and a driving control part for controlling a drive of the motor included in the driving mechanism 70 on the basis of the position of the arm shaft 82a and the position of the output shaft 75a.

Description

本発明は、物体把持装置および景品取得ゲーム装置に関する。   The present invention relates to an object gripping device and a prize acquisition game device.

筐体の内部に収納された景品の獲得を目的とするクレーンゲーム機のような景品取得ゲーム装置は、その操作に面白味があるとともに、人気のあるキャラクタ等を景品に用いることでプレーヤの挑戦意欲をそそるため、アミューズメント施設はもちろんのこと、一般の店舗やショッピングモール等にも多く設置されている。従来、このような景品取得ゲーム装置として様々なものが提案され、商品化されている(例えば、下記特許文献1および特許文献2参照)。このような景品取得ゲーム装置では、景品を保持して持ち上げる物体把持装置のアームの把持力が、景品の取得率に大きな影響を与えるため、把持力を調整する仕組みが必要となる。   A prize acquisition game device such as a crane game machine for the purpose of acquiring a prize stored inside the case is interesting in its operation, and the player's willingness to challenge by using popular characters as prizes Therefore, many are installed not only in amusement facilities but also in general stores and shopping malls. Conventionally, various types of prize acquisition game devices have been proposed and commercialized (for example, see Patent Document 1 and Patent Document 2 below). In such a prize acquisition game device, since the gripping force of the arm of the object gripping device that holds and lifts the prize has a great influence on the prize acquisition rate, a mechanism for adjusting the gripping force is required.

特許文献1に記載の物体把持装置では、アームと閉方向駆動機構とを引っ張りばねで連結し、閉方向駆動機構の閉め込み位置を調整することで把持力を変化させている。しかしながら、特許文献1に記載の物体把持装置では、ばねが閉方向に付勢しない状態でアームが閉じられても、アームの自重によって把持力が発生してしまうため、景品の重さや形状によっては景品が容易に取得されてしまい、難易度の調整が困難であった。   In the object gripping device described in Patent Document 1, the grip force is changed by connecting the arm and the closing direction driving mechanism with a tension spring and adjusting the closing position of the closing direction driving mechanism. However, in the object gripping device described in Patent Document 1, even if the arm is closed without the spring being biased in the closing direction, a gripping force is generated due to the weight of the arm, so depending on the weight and shape of the prize. It was difficult to adjust the degree of difficulty because the prize was easily acquired.

一方、特許文献2に記載の物体把持装置は、電動モータでアームを直接駆動することにより、アームの自重を打ち消している。   On the other hand, the object gripping device described in Patent Document 2 directly cancels the weight of the arm by directly driving the arm with an electric motor.

特開2008−279306号公報JP 2008-279306 A 特開2006−43303号公報JP 2006-43303 A

ところで、特許文献2に記載の物体把持装置では、アームの自重を打ち消すために、高出力で微小なトルク制御を行っている。しかしながら、このようなトルク制御を行う場合には、高出力で慣性モーメントが小さい小型のモータを備える必要があり、このような小型のモータは、一般に高価である。また、高出力で微小なトルク制御は発熱が伴うため連続して行うことは困難であり、モータの寿命が短くなる要因にもなり得る。   By the way, in the object gripping device described in Patent Document 2, high torque and minute torque control are performed in order to cancel the weight of the arm. However, when performing such torque control, it is necessary to provide a small motor with high output and a small moment of inertia, and such a small motor is generally expensive. In addition, high-output and minute torque control is difficult to perform continuously because it generates heat, and may cause a reduction in the life of the motor.

そこで、本発明は、従来よりも安価な電動機でアームの自重による把持力よりも弱い把持力を実現することができる物体把持装置および景品取得ゲーム装置を提供することを目的とする。   Therefore, an object of the present invention is to provide an object gripping device and a prize acquisition game device that can realize a gripping force that is weaker than the gripping force due to the weight of the arm with an electric motor that is less expensive than before.

上述した課題を解決するため、本発明に係る物体把持装置は、可動式のベース部に取り付け可能であり、物体を把持するためのアームを含む、1つまたは複数のアーム部と、前記1つまたは複数のアーム部に対応する1つまたは複数の駆動機構と、前記アーム部と前記駆動機構とを連結する弾性体と、前記アーム部が回動する際のアーム軸の位置を検出するアーム軸位置検出部と、前記駆動機構の位置を検出する駆動機構位置検出部と、前記アーム軸の位置および前記駆動機構の位置に基づいて、前記駆動機構の駆動を制御する駆動制御部と、を備えることを特徴とする。   In order to solve the above-described problems, an object gripping device according to the present invention is attachable to a movable base portion, and includes one or a plurality of arm portions including an arm for gripping an object, and the one Alternatively, one or a plurality of drive mechanisms corresponding to a plurality of arm portions, an elastic body that connects the arm portions and the drive mechanism, and an arm shaft that detects the position of the arm shaft when the arm portions rotate. A position detection unit; a drive mechanism position detection unit that detects the position of the drive mechanism; and a drive control unit that controls the drive of the drive mechanism based on the position of the arm shaft and the position of the drive mechanism. It is characterized by that.

この発明によれば、弾性体が駆動機構とアーム部とを連結するため、駆動機構から付与される力によって変形する弾性体がアーム部に力を与えることでアーム部に開閉動作を行わせることができる。これにより、アーム軸の位置および駆動機構の位置に基づいて駆動機構を制御することができるため、位置制御を行うことでアーム部に開閉動作を行わせることが可能となる。それゆえに、トルク制御に必要な電動機よりも安価な、例えばステッピングモータやDCモータ等の電動機を使用することが可能となり、トルク制御に用いることができない、例えば超音波モータ等の電動機を使用することが可能となる。また、電動機の慣性モーメントがアーム軸に与える影響を低減することができるため、慣性モーメントの大きい電動機を使用することが可能となる。さらに、駆動時に発生する微振動を弾性体である程度吸収することができるため、精度の低い電動機を使用した場合であっても、アーム部側への影響を抑制することが可能となる。   According to this invention, since the elastic body connects the drive mechanism and the arm portion, the elastic body deformed by the force applied from the drive mechanism applies a force to the arm portion, thereby causing the arm portion to perform an opening / closing operation. Can do. As a result, the drive mechanism can be controlled based on the position of the arm shaft and the position of the drive mechanism, so that the arm portion can be opened and closed by performing position control. Therefore, it becomes possible to use an electric motor such as a stepping motor or a DC motor that is less expensive than an electric motor required for torque control, and cannot use an electric motor such as an ultrasonic motor that cannot be used for torque control. Is possible. In addition, since the influence of the inertia moment of the motor on the arm shaft can be reduced, it is possible to use a motor having a large inertia moment. Further, since the micro-vibration generated at the time of driving can be absorbed to some extent by the elastic body, the influence on the arm portion side can be suppressed even when a low-precision motor is used.

上記物体把持装置において、上記駆動制御部は、予め測定した前記アーム軸の位置に対して均衡する前記駆動機構の出力軸の位置である均衡位置を用いて前記駆動機構の駆動を制御し、前記弾性体は、前記駆動機構の駆動に応じて変形し、前記アーム部は、前記弾性体の変形により付加される力で把持力を発生させることができる。   In the object gripping device, the drive control unit controls driving of the drive mechanism using a balanced position that is a position of an output shaft of the drive mechanism that balances with respect to a position of the arm axis measured in advance, The elastic body is deformed in accordance with the drive of the drive mechanism, and the arm portion can generate a gripping force with a force applied by the deformation of the elastic body.

これにより、アーム部の自重を加味して測定された均衡位置を基準にしてアーム部の動作を制御することができるため、アーム部の自重による把持力を打ち消した状態でアーム部を開閉させることが可能となる。   As a result, it is possible to control the operation of the arm part based on the measured equilibrium position with the weight of the arm part taken into account, so that the arm part can be opened and closed while the gripping force due to the weight of the arm part is canceled. Is possible.

上記物体把持装置において、上記駆動制御部は、前記駆動機構の出力軸の目標位置として、前記均衡位置に予め設定した値を加えた位置を設定し、前記駆動機構の駆動を制御することができる。   In the object gripping apparatus, the drive control unit can set a position obtained by adding a preset value to the balanced position as a target position of the output shaft of the drive mechanism, and can control driving of the drive mechanism. .

これにより、均衡位置に所望の値を加えて制御することができるため、アームの自重による把持力よりも弱い把持力から、強い把持力まで、様々な強さの把持力を自在に発生させることが可能となる。   As a result, the balance position can be controlled by adding a desired value, so that various gripping forces can be freely generated from gripping force weaker than the gripping force due to the weight of the arm to strong gripping force. Is possible.

上記物体把持装置において、上記予め設定した値は、前記アーム軸の複数の位置ごとに設定することができる。   In the object gripping device, the preset value can be set for each of a plurality of positions of the arm shaft.

これにより、様々な特性を有するアーム部を実現することが可能となる。   Thereby, it is possible to realize an arm portion having various characteristics.

上記物体把持装置において、上記均衡位置を測定する均衡位置測定部を、さらに備え、前記均衡位置測定部は、前記アーム部の回動が停止する位置を用いて前記アーム部の可動範囲を決定し、前記アーム部の可動範囲内における前記均衡位置を測定することができる。   The object gripping apparatus further includes an equilibrium position measurement unit that measures the equilibrium position, and the equilibrium position measurement unit determines a movable range of the arm unit using a position where the rotation of the arm unit stops. The equilibrium position within the movable range of the arm portion can be measured.

上記物体把持装置において、上記均衡位置測定部は、前記アームが異なる種別に交換されるたびに前記均衡位置を測定することができる。   In the object gripping apparatus, the balanced position measuring unit can measure the balanced position every time the arm is replaced with a different type.

上記物体把持装置において、上記アーム部の可動範囲内における前記均衡位置に基づいて、前記アーム部の可動範囲外における前記均衡位置を推定する均衡位置推定部を、さらに備えることができる。   The object gripping apparatus may further include a balanced position estimating unit that estimates the balanced position outside the movable range of the arm unit based on the balanced position within the movable range of the arm unit.

これにより、アーム部の可動範囲が変わった場合であっても、均衡位置の再測定を不要にすることが可能となる。   As a result, even when the movable range of the arm portion is changed, it is possible to eliminate the need for re-measurement of the equilibrium position.

上記物体把持装置において、上記アーム部の回動動作を急変動させた後の前記アーム軸の位置変化の特性を算出し、予め記憶した既知の前記アームの前記位置変化の特性と比較して前記アームの種別を判定するアーム種別判定部を、さらに備えることができる。   In the object gripping device, the position change characteristic of the arm shaft after abruptly changing the rotation operation of the arm unit is calculated, and compared with a previously stored characteristic of the position change of the arm. An arm type determination unit that determines the type of the arm can be further provided.

上記物体把持装置において、上記アームの種別に基づいて、少なくとも前記ベース部の稼働範囲、稼働速度または稼働方式のいずれか一つを変更する稼働制御部を、さらに備えることができる。   The object gripping device may further include an operation control unit that changes at least one of an operation range, an operation speed, and an operation method of the base unit based on the type of the arm.

上記物体把持装置において、上記アーム部の回動動作を急変動させた後の前記アーム軸の位置変化の特性を算出し、前記アームの重さと重心の偏りを推定する推定部を、さらに備えることができる。   The object gripping apparatus further includes an estimation unit that calculates a characteristic of a position change of the arm shaft after suddenly changing a rotation operation of the arm unit and estimates a weight of the arm and a deviation of the center of gravity. Can do.

上記物体把持装置において、上記アームの重さと重心の偏りに基づいて、少なくとも前記ベース部の稼働範囲、稼働速度または稼働方式のいずれか一つを変更する稼働制御部を、さらに備えることができる。   The object gripping device may further include an operation control unit that changes at least one of the operation range, the operation speed, and the operation method of the base unit based on the weight of the arm and the deviation of the center of gravity.

上記物体把持装置において、上記駆動機構は少なくとも電動機を含み、上記駆動制御部は前記電動機の駆動を制御することとしてもよい。   In the object gripping apparatus, the drive mechanism may include at least an electric motor, and the drive control unit may control driving of the electric motor.

本発明によれば、従来よりも安価な電動機でアームの自重による把持力よりも弱い把持力を実現することができる。   According to the present invention, it is possible to realize a gripping force that is weaker than the gripping force due to the weight of the arm with an electric motor that is less expensive than the conventional one.

実施形態における景品取得ゲーム装置の外観構成を示す斜視図である。It is a perspective view showing appearance composition of a prize acquisition game device in an embodiment. 実施形態における景品取得ゲーム装置を上部方向から見た場合の斜視図である。It is a perspective view at the time of seeing the prize acquisition game device in an embodiment from the upper part. 実施形態における物体把持装置の外観構成を示す斜視図である。It is a perspective view showing appearance composition of an object grasping device in an embodiment. 図3に示す物体把持装置の一部を分解した状態で示す斜視図である。It is a perspective view shown in the state which decomposed | disassembled some object gripping apparatuses shown in FIG. 実施形態における物体把持装置の機能構成を示すブロック図である。It is a block diagram which shows the function structure of the object holding | grip apparatus in embodiment. 急変動前後のアーム軸の位置と出力軸の位置との間の変化の相関関係を示す図である。It is a figure which shows the correlation of the change between the position of the arm axis | shaft before and behind sudden change, and the position of an output shaft. 急変動前後のアーム軸の位置の時間変化を示す図である。It is a figure which shows the time change of the position of the arm axis | shaft before and behind sudden change. アーム部の可動範囲を決定する際の動作を示すフローチャート(その1)である。It is a flowchart (the 1) which shows the operation | movement at the time of determining the movable range of an arm part. アーム部の可動範囲を決定する際の動作を示すフローチャート(その2)である。It is a flowchart (the 2) which shows the operation | movement at the time of determining the movable range of an arm part. アーム軸と出力軸との均衡時における位置関係を測定する際の動作を示すフローチャートである。It is a flowchart which shows the operation | movement at the time of measuring the positional relationship at the time of the balance of an arm axis | shaft and an output shaft. アーム部を開閉する際の動作を示すフローチャートである。It is a flowchart which shows the operation | movement at the time of opening and closing an arm part. アームの種別を判定する際の動作を示すフローチャートである。It is a flowchart which shows the operation | movement at the time of determining the classification of an arm.

以下、本発明の実施形態を、図面を参照して詳細に説明する。最初に、景品取得ゲーム装置の概略構成について説明する。図1は、実施形態における景品取得ゲーム装置の外観構成を示す斜視図である。図2は、実施形態における景品取得ゲーム装置を上部方向から見た場合の斜視図である。   Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings. First, a schematic configuration of the prize acquisition game device will be described. FIG. 1 is a perspective view illustrating an external configuration of a prize acquisition game device according to the embodiment. FIG. 2 is a perspective view of the prize acquisition game device according to the embodiment when viewed from above.

図1に示すように、景品取得ゲーム装置100は、直方体の基台1と、基台1の上に設けられた箱型の収容部2とから構成される。収容部2には、ぬいぐるみ等の景品3が収容される。収容部2の底部には、景品3を受けるための景品投入部4が設けられている。   As shown in FIG. 1, the prize acquisition game device 100 includes a rectangular parallelepiped base 1 and a box-shaped storage unit 2 provided on the base 1. The storage unit 2 stores premiums 3 such as stuffed animals. At the bottom of the housing part 2, a prize input part 4 for receiving a prize 3 is provided.

収容部2の内部上面には、物体把持装置5が吊り下げられている。物体把持装置5は、内部上面から鉛直方向に吊り下げられた伸縮パイプからなる支持部6と、支持部6の下端に設けられたベース部7と、ベース部7に取り付けられた2本のアーム部8とを有する。2本のアーム部8は、通常は閉じた状態となっているが、景品を掴む際に開くように構成されている。ベース部7は、カバーで覆われている。   An object gripping device 5 is suspended from the inner upper surface of the housing portion 2. The object gripping device 5 includes a support portion 6 made of an elastic pipe suspended in a vertical direction from the inner upper surface, a base portion 7 provided at the lower end of the support portion 6, and two arms attached to the base portion 7. Part 8. The two arm portions 8 are normally in a closed state, but are configured to open when grabbing a prize. The base part 7 is covered with a cover.

基台1には、プレーヤがプレイするための操作卓12が設けられている。操作卓12には、物体把持装置5を所望の景品3に対応する位置に停止させるためのボタンスイッチ13が設けられている。基台1の下方には、景品の取出口15と、開閉扉16とが設けられている。開閉扉16の内側には、店舗の管理者が景品取得ゲーム装置100の各種設定を行うための操作ボタン、操作ダイヤルおよび液晶パネル等のインタフェース(不図示)が設けられている。店舗の管理者が操作ボタン等を操作して各種設定を行うと、基台1内部に設けられたコンピュータが、その設定に基づいて景品取得ゲーム装置100を制御する。   The base 1 is provided with a console 12 for a player to play. The console 12 is provided with a button switch 13 for stopping the object gripping device 5 at a position corresponding to the desired prize 3. A prize outlet 15 and an opening / closing door 16 are provided below the base 1. Inside the open / close door 16, an interface (not shown) such as an operation button, an operation dial, and a liquid crystal panel for a store manager to perform various settings of the prize acquisition game device 100 is provided. When the store manager operates the operation buttons or the like to make various settings, a computer provided in the base 1 controls the prize acquisition game device 100 based on the settings.

図2に示すように、収容部2の内部上面には、物体把持装置5が走行するための横行用固定レール9と、縦行用可動レール10とが設けられている。支持部6は、物体把持装置用基台11を介して縦行用可動レール10に配置されている。支持部6は、駆動源を含む稼働機構(不図示)によって横行用固定レール9および縦行用可動レール10上を走行可能に構成され、かつ上下方向にも伸縮可能に構成されている。   As shown in FIG. 2, a transverse fixed rail 9 and a longitudinal movable rail 10 for the object gripping device 5 to travel are provided on the inner upper surface of the housing portion 2. The support portion 6 is disposed on the movable rail 10 for longitudinal movement through the base 11 for an object gripping device. The support portion 6 is configured to be able to travel on the transverse fixed rail 9 and the longitudinal movable rail 10 by an operating mechanism (not shown) including a drive source, and is also configured to be extendable in the vertical direction.

以下、本実施形態における景品取得ゲーム装置100の物体把持装置5について説明する。最初に、物体把持装置5の外観構成について説明する。図3は、カバーを外した状態の物体把持装置の外観構成を示す斜視図である。図4は、図3に示す物体把持装置の一部を分解した状態で示す斜視図である。   Hereinafter, the object gripping device 5 of the prize acquisition game device 100 in the present embodiment will be described. First, the external configuration of the object gripping device 5 will be described. FIG. 3 is a perspective view showing an external configuration of the object gripping apparatus with the cover removed. 4 is a perspective view showing a part of the object gripping device shown in FIG. 3 in an exploded state.

物体把持装置5のアーム部8は、景品を把持するためのアーム81と、アーム81をベース部7に取り付ける基端部82と、景品を把持し易くする爪83とを有する。基端部82は、アーム部8が回動する際の軸となるアーム軸82aと、ベース部7の弾性体73の一部を基端部82に固定するための弾性体固定部82bと、を有する。   The arm portion 8 of the object gripping device 5 includes an arm 81 for gripping a prize, a base end portion 82 for attaching the arm 81 to the base portion 7, and a claw 83 for easily gripping the prize. The base end portion 82 includes an arm shaft 82a serving as an axis when the arm portion 8 rotates, an elastic body fixing portion 82b for fixing a part of the elastic body 73 of the base portion 7 to the base end portion 82, Have

物体把持装置5のベース部7は、ギアボックス71、ギア75およびモータ77を含んで構成する駆動機構70と、駆動機構70の出力軸75aの位置を検出する駆動機構位置検出部72と、アーム部8と駆動機構70とを連結する弾性体73(例えばトーションバネ)と、アーム部8が回動する際のアーム軸82aの位置を検出するアーム軸位置検出部74と、を有する。駆動機構70は、各アーム部8に対応して設けられる。   The base unit 7 of the object gripping device 5 includes a drive mechanism 70 including a gear box 71, a gear 75, and a motor 77, a drive mechanism position detection unit 72 that detects the position of the output shaft 75a of the drive mechanism 70, and an arm. An elastic body 73 (for example, a torsion spring) that connects the portion 8 and the drive mechanism 70 and an arm shaft position detection portion 74 that detects the position of the arm shaft 82a when the arm portion 8 rotates. The drive mechanism 70 is provided corresponding to each arm portion 8.

上記出力軸75aやアーム軸82aの位置としては、例えば、各軸の基準位置からの回転角度や距離等を用いることができる。本実施形態では、各軸の位置として、基準位置からの回転角度を用いて説明する。また、基準位置として、アーム部が開方向リミット位置に位置するときの各軸の位置を用いて説明する。つまり、アーム部が開方向リミット位置に位置するときの各軸の位置(角度)を基準位置(例えば0)とし、アーム部が閉じるにつれて、各軸の位置(角度)が大きくなり、アーム部が閉方向リミット位置に到達したときに、各軸の位置(角度)が最大となる。   As the positions of the output shaft 75a and the arm shaft 82a, for example, the rotation angle or distance from the reference position of each axis can be used. In the present embodiment, description will be made using the rotation angle from the reference position as the position of each axis. Further, description will be made using the position of each axis when the arm portion is positioned at the opening direction limit position as the reference position. In other words, the position (angle) of each axis when the arm part is located at the opening direction limit position is set as a reference position (for example, 0), and as the arm part is closed, the position (angle) of each axis increases, When the closing direction limit position is reached, the position (angle) of each axis is maximized.

なお、本実施形態では、回動式の駆動機構70を用いて説明するが、これに限定されず、直動式の駆動機構を用いることとしてもよい。また、キアボックス71およびギア75を介することなく、モータ77の軸(不図示)を弾性体73に直結することとしてもよい。   In the present embodiment, the description will be made using the rotational drive mechanism 70, but the present invention is not limited to this, and a direct-acting drive mechanism may be used. Further, the shaft (not shown) of the motor 77 may be directly connected to the elastic body 73 without using the kia box 71 and the gear 75.

物体把持装置5のアーム部8の開閉動作は、以下のしくみで行われる。駆動機構70のモータ77を駆動すると、駆動機構70の出力軸75aに連結する歯車75および留め具76と弾性体固定部82bとで固定されている弾性体73が変形する。続いて、弾性体73の変形に応じて弾性体73からアーム部8に力が加えられ、アーム部8が開閉動作を行う。弾性体73の力がアーム部8を押し下げる方向(アーム部8の内転方向)に作用する場合には、アーム部8が閉方向に動作し、弾性体73の力がアーム部8を引き上げる方向(アーム部8の外転方向)に作用する場合には、アーム部8が開方向に動作する。   The opening / closing operation of the arm unit 8 of the object gripping device 5 is performed by the following mechanism. When the motor 77 of the drive mechanism 70 is driven, the elastic body 73 fixed by the gear 75 and the fastener 76 connected to the output shaft 75a of the drive mechanism 70 and the elastic body fixing portion 82b is deformed. Subsequently, a force is applied from the elastic body 73 to the arm portion 8 according to the deformation of the elastic body 73, and the arm portion 8 performs an opening / closing operation. When the force of the elastic body 73 acts in a direction in which the arm portion 8 is pushed down (inward direction of the arm portion 8), the arm portion 8 operates in the closing direction, and the force of the elastic body 73 pulls up the arm portion 8. When acting on (the direction of outer rotation of the arm portion 8), the arm portion 8 operates in the opening direction.

駆動機構位置検出部72の検出値θmおよびアーム軸位置検出部74の検出値θaは、駆動機構70が弾性体73に力を付与する際や、出力軸とアーム軸との位置関係を確認して把持力制御を行う際に使用される。   The detection value θm of the drive mechanism position detection unit 72 and the detection value θa of the arm shaft position detection unit 74 confirm the positional relationship between the output shaft and the arm shaft when the drive mechanism 70 applies force to the elastic body 73. Used when gripping force control is performed.

本実施形態では、アーム部8と駆動機構70とが弾性体73を介して連結されているため、駆動機構70の出力軸75aの可動範囲を、アーム部8のアーム軸82a可動範囲よりも大きくすることが可能となる。つまり、アーム部8がストッパ部材や物等に当接して停止した後も、弾性体73が変形可能な間は、出力軸75aをそのまま回転し続けることが可能となる。   In the present embodiment, since the arm portion 8 and the drive mechanism 70 are coupled via the elastic body 73, the movable range of the output shaft 75a of the drive mechanism 70 is larger than the movable range of the arm shaft 82a of the arm portion 8. It becomes possible to do. That is, even after the arm portion 8 comes into contact with the stopper member or an object and stops, the output shaft 75a can continue to rotate as long as the elastic body 73 can be deformed.

次に、物体把持装置5の機能構成について説明する。図5は、物体把持装置の機能構成を示すブロック図である。物体把持装置5は、制御部50として、例えば、駆動制御部51と、均衡位置測定部52と、均衡位置推定部53と、アーム種別判定部54と、稼働制御部55と、を有する。   Next, the functional configuration of the object gripping device 5 will be described. FIG. 5 is a block diagram illustrating a functional configuration of the object gripping apparatus. The object gripping device 5 includes, as the control unit 50, for example, a drive control unit 51, an equilibrium position measurement unit 52, an equilibrium position estimation unit 53, an arm type determination unit 54, and an operation control unit 55.

駆動制御部51は、駆動機構70に含まれるモータを駆動させることで、アーム部8の開閉動作を制御する。   The drive control unit 51 controls the opening / closing operation of the arm unit 8 by driving a motor included in the drive mechanism 70.

具体的に、駆動制御部51は、アーム軸82aの位置に対して均衡する駆動機構70の出力軸75aの位置(以下、「均衡位置」という。)を用い、出力軸75aの目標位置を、均衡位置からずらした位置に設定することで、アーム部8の開閉を制御する。均衡位置は予め測定され、記憶部18に記憶されている。   Specifically, the drive control unit 51 uses the position of the output shaft 75a of the drive mechanism 70 that balances with respect to the position of the arm shaft 82a (hereinafter referred to as “balanced position”), and sets the target position of the output shaft 75a as By setting the position shifted from the equilibrium position, the opening and closing of the arm unit 8 is controlled. The equilibrium position is measured in advance and stored in the storage unit 18.

出力軸75aの目標位置を均衡位置よりも、どの程度ずらすのかによって、アーム部8の把持力を決めることができる。ずらしの度合は、例えば把持力値pとして表すことができる。この把持力値pを、所望する把持力に応じて設定する。例えばアーム部8が閉じる動作をしている際に物に当接して動かなくなった場合、出力軸75aの目標位置がその時点の均衡位置よりも把持力値pに応じた角度だけ大きくなるように制御することで、所望する把持力を実現することができる。   The gripping force of the arm portion 8 can be determined depending on how much the target position of the output shaft 75a is shifted from the equilibrium position. The degree of shifting can be expressed as a gripping force value p, for example. This gripping force value p is set according to a desired gripping force. For example, when the arm portion 8 is in a closing motion and does not move due to contact with an object, the target position of the output shaft 75a is larger than the balanced position at that time by an angle corresponding to the gripping force value p. By controlling, a desired gripping force can be realized.

なお、把持力値pは、一定の値であってもよいし、アーム軸82aの位置に応じて変動させることとしてもよい。把持力値pを一定の値にすることで、アーム部8の状態に関わらず一定の把持力を発揮させることができる。一方、把持力値pをアーム軸82aの位置に応じて変動させることで、様々な特性を有するアーム部を実現することが可能となる。例えば、アーム部8が開く方向に動作するのに応じて把持力値pが大きくなるようにすれば、ばねで引っ張られているような従来技術のアーム部と同様の特性を実現することができる。   Note that the gripping force value p may be a constant value or may be varied according to the position of the arm shaft 82a. By setting the gripping force value p to a constant value, a constant gripping force can be exhibited regardless of the state of the arm portion 8. On the other hand, by varying the gripping force value p in accordance with the position of the arm shaft 82a, it is possible to realize an arm portion having various characteristics. For example, if the gripping force value p is increased in accordance with the movement of the arm portion 8 in the opening direction, the same characteristics as those of a conventional arm portion that is pulled by a spring can be realized. .

駆動制御部51は、出力軸75aの目標位置として、均衡位置に把持力値pを加えた位置を設定してモータを駆動することで、アーム部8に所望の把持力を発生させる。   The drive control unit 51 sets a position obtained by adding the gripping force value p to the balanced position as a target position of the output shaft 75a, and drives the motor to generate a desired gripping force in the arm unit 8.

駆動制御部51は、駆動機構位置検出部72の検出値θmが目標位置の値よりも大きな値を示す場合には、アーム部8が開く方向にモータを駆動させ、検出値θmが目標位置の値よりも小さな値を示す場合には、アーム部8が閉じる方向にモータを駆動させる。なお、モータの駆動方向を決定する際の判定基準となる目標位置に、マージンとして敏感度sを加えることとしてもよい。敏感度sを加算することで、検出値θmに誤差が含まれている場合や、モータの速度制御の精度が低い場合に生じ得るアーム部8の開閉動作の発振現象を抑制することが可能となる。   When the detection value θm of the drive mechanism position detection unit 72 is larger than the target position value, the drive control unit 51 drives the motor in the direction in which the arm unit 8 opens, and the detection value θm is the target position value. When the value is smaller than the value, the motor is driven in the direction in which the arm portion 8 is closed. Note that the sensitivity s may be added as a margin to a target position that is a criterion for determining the motor driving direction. By adding the sensitivity s, it is possible to suppress the oscillation phenomenon of the opening / closing operation of the arm unit 8 that may occur when the detection value θm includes an error or when the speed control accuracy of the motor is low. Become.

均衡位置測定部52は、アーム部8の回動が停止する位置を測定してアーム部8の可動範囲を決定し、アーム部8の可動範囲内における均衡位置を測定する。均衡位置は、アーム軸82aの位置に応じて、そのときのアーム軸82aの位置と均衡している駆動機構70の出力軸75aの位置を測定していくことで求めることができる。測定した均衡位置は、記憶部18に記憶する。なお、均衡位置の測定は、アーム81が異なる種別のアーム81に交換されるたびに実行することとしてもよい。これにより、未知のアームに交換された場合であっても測定し直した均衡位置を用いて対応することが可能となる。また、複数の既知のアームの均衡位置を予め登録しておき、アームを交換したときに、登録されている複数の均衡位置の中から、交換後のアームに対応する均衡位置をスイッチ等を用いて選択することとしてもよい。   The balanced position measuring unit 52 determines the movable range of the arm unit 8 by measuring the position where the rotation of the arm unit 8 stops, and measures the balanced position within the movable range of the arm unit 8. The balanced position can be obtained by measuring the position of the output shaft 75a of the drive mechanism 70 that is balanced with the position of the arm shaft 82a at that time, according to the position of the arm shaft 82a. The measured equilibrium position is stored in the storage unit 18. The measurement of the equilibrium position may be performed every time the arm 81 is replaced with a different type of arm 81. As a result, even when the arm is replaced with an unknown arm, it is possible to cope with the re-measured equilibrium position. In addition, when the balanced positions of a plurality of known arms are registered in advance and the arm is replaced, the balanced position corresponding to the arm after the replacement is selected from a plurality of registered balanced positions using a switch or the like. It may be selected.

均衡位置推定部53は、既に測定済みのアーム部8の可動範囲内における均衡位置に基づいて、アーム部8の可動範囲外における均衡位置を推定する。これは、物体把持装置5では、アーム81の形状や爪83の形状に応じて、アーム部8の閉まる位置を変更することができ、アーム部8の閉まる位置を変更した場合には、アーム部8の可動範囲が変わるため、これに対応できるようにしたものである。つまり、アーム部8の可動範囲が変わっても、均衡位置の再測定を不要とするために、予めアーム部8の可動範囲外における均衡位置も算出しておくこととしたものである。   The equilibrium position estimation unit 53 estimates the equilibrium position outside the movable range of the arm unit 8 based on the already measured equilibrium position within the movable range of the arm unit 8. This is because the object gripping device 5 can change the closing position of the arm unit 8 according to the shape of the arm 81 or the shape of the claw 83, and when the closing position of the arm unit 8 is changed, Since the movable range of 8 changes, it can cope with this. That is, even if the movable range of the arm unit 8 changes, the balanced position outside the movable range of the arm unit 8 is also calculated in advance so that it is not necessary to remeasure the balanced position.

アーム種別判定部54は、アーム部8の回動動作を急変動させた後のアーム軸82aの位置変化の特性を算出し、予め記憶部18に記憶されている既知のアームの位置変化の特性と比較してアーム81の種別を判定する。回動動作の急変動としては、例えば、アーム部8を急加速させることや、駆動機構70の出力軸75aを急制動させることが該当する。アーム部8を急加速させると、アーム軸82aの加速の遅延度合に基づいて、アーム81の重さや重心の偏りの特性を推定することができる。また、出力軸75aを急制動させると、アーム軸82aが停止するまでの位置変化に基づいて、アーム81の重さや重心の偏りの特性を推定することができる。   The arm type determination unit 54 calculates the characteristics of the position change of the arm shaft 82a after suddenly changing the rotational movement of the arm section 8, and the known characteristics of the position change of the arm stored in the storage unit 18 in advance. And the type of the arm 81 is determined. The sudden fluctuation of the turning operation corresponds to, for example, sudden acceleration of the arm unit 8 or sudden braking of the output shaft 75a of the drive mechanism 70. If the arm portion 8 is accelerated rapidly, the characteristics of the weight of the arm 81 and the bias of the center of gravity can be estimated based on the degree of acceleration delay of the arm shaft 82a. Further, when the output shaft 75a is suddenly braked, the characteristics of the weight of the arm 81 and the bias of the center of gravity can be estimated based on the position change until the arm shaft 82a stops.

アーム軸82aの位置変化の特性は、例えば、アーム部8の回動動作を急変動させた後のアーム軸82aの位置と出力軸75aの位置との間の変化の相関関係に基づいて算出することができる。図6に、その相関関係を表すグラフを例示する。図6に示すLは種別が大サイズのアームの特性グラフであり、Mは種別が中サイズのアームの特性グラフであり、Sは種別が小サイズのアームの特性グラフである。   The characteristic of the position change of the arm shaft 82a is calculated based on, for example, the correlation of the change between the position of the arm shaft 82a and the position of the output shaft 75a after suddenly changing the turning operation of the arm unit 8. be able to. FIG. 6 illustrates a graph representing the correlation. 6 is a characteristic graph of an arm having a large type, M is a characteristic graph of an arm having a medium type, and S is a characteristic graph of an arm having a small type.

図6に示すように、特性グラフごとに、Δθa=0となる特徴点(極値)の個数や位置が相違する。このような相違は、アームの自重や重心の位置によって変動する慣性モーメントの相違により現れる。したがって、アーム種別判定部54は、Δθa=0となる特徴点の個数や位置を比較することで、アームの種別を判定することが可能となる。   As shown in FIG. 6, the number and position of feature points (extreme values) where Δθa = 0 are different for each characteristic graph. Such a difference appears due to a difference in moment of inertia that varies depending on the weight of the arm and the position of the center of gravity. Therefore, the arm type determination unit 54 can determine the type of arm by comparing the number and position of feature points where Δθa = 0.

なお、アーム軸82aの位置変化の特性は、上記相関関係に基づいて算出することには限定されない。例えば、急変動中の均衡位置とのずれ具合や、急変動後のアーム軸82aの位置の時間変化に基づいて算出してもよい。図7に、アーム部8の回動動作を急変動させた前後の経過時間に対するアーム軸82aの位置変化を表すグラフを例示する。この場合も、アーム種別判定部54は、Δθa=0となる特徴点の個数や位置を比較することで、アーム81の種別を判定することができる。   The characteristic of the position change of the arm shaft 82a is not limited to the calculation based on the correlation. For example, the calculation may be performed based on the degree of deviation from the equilibrium position during a sudden change or the time change in the position of the arm shaft 82a after the sudden change. FIG. 7 illustrates a graph representing a change in the position of the arm shaft 82a with respect to the elapsed time before and after the pivoting operation of the arm unit 8 is suddenly changed. Also in this case, the arm type determination unit 54 can determine the type of the arm 81 by comparing the number and position of feature points where Δθa = 0.

稼働制御部55は、アーム81の種別に基づいて、ベース部7の稼働範囲や稼働速度、稼働方式を変更する。なお、稼働範囲、稼働速度、稼働方式のうちのいずれか一つを変更することとしてもよい。また、アーム81の種別に基づいて、予め記憶部18に記憶されている均衡位置を変更することとしてもよい。また、変更する際の判定基準は、アーム81の種別に基づくことには限定されず、例えば、アーム81の重さと重心の偏りに基づいて変更することとしてもよい。この場合には、例えば、アーム部8の回動動作を急変動させた後のアーム軸82aの位置変化の特性を算出し、アーム81の重さと重心の偏りを推定する推定部を備えることとすればよい。   The operation control unit 55 changes the operation range, operation speed, and operation method of the base unit 7 based on the type of the arm 81. Note that any one of the operating range, the operating speed, and the operating method may be changed. Further, the equilibrium position stored in advance in the storage unit 18 may be changed based on the type of the arm 81. Further, the determination criterion when changing is not limited to being based on the type of the arm 81, and may be changed based on, for example, the weight of the arm 81 and the bias of the center of gravity. In this case, for example, an estimation unit that calculates the characteristics of the position change of the arm shaft 82a after suddenly changing the rotation operation of the arm unit 8 and estimates the weight of the arm 81 and the deviation of the center of gravity is provided. do it.

次に、物体把持装置5の動作について説明する。最初に、図8および図9を参照して、アーム部8の可動範囲を決定する際の動作について説明する。   Next, the operation of the object gripping device 5 will be described. Initially, with reference to FIG. 8 and FIG. 9, the operation | movement at the time of determining the movable range of the arm part 8 is demonstrated.

最初に、駆動制御部51は、アーム部8がリミット位置以外に位置するようにモータを駆動させる(ステップS101)。   First, the drive control unit 51 drives the motor so that the arm unit 8 is located at a position other than the limit position (step S101).

続いて、駆動制御部51は、アーム部8が閉じる方向にモータを駆動させ(ステップS102)、アーム軸位置検出部74の検出値θaに基づいてアーム部8が停止したか否かを判定する(ステップS103)。この判定がNOである場合(ステップS103;NO)に、駆動制御部51は、アーム部8が停止するまでモータを駆動させる。   Subsequently, the drive control unit 51 drives the motor in the closing direction of the arm unit 8 (step S102), and determines whether or not the arm unit 8 has stopped based on the detection value θa of the arm shaft position detection unit 74. (Step S103). When this determination is NO (step S103; NO), the drive control unit 51 drives the motor until the arm unit 8 stops.

一方、上記ステップS103の判定でアーム部8が停止したと判定された場合(ステップS103;YES)に、均衡位置測定部52は、この時点のアーム軸位置検出部74の検出値θaを、第1閉方向リミット位置として記憶部18に記憶させる(ステップS104)。   On the other hand, when it is determined in step S103 that the arm unit 8 has stopped (step S103; YES), the equilibrium position measurement unit 52 determines the detected value θa of the arm axis position detection unit 74 at this time as the first value. The first closing direction limit position is stored in the storage unit 18 (step S104).

続いて、駆動制御部51は、アーム部8が開く方向にモータを駆動させ(ステップS105)、アーム軸位置検出部74の検出値θaに基づいてアーム部8が開動作を開始したか否かを判定する(ステップS106)。この判定がNOである場合(ステップS106;NO)に、駆動制御部51は、アーム部8が開動作を開始するまでモータを駆動させる。   Subsequently, the drive control unit 51 drives the motor in a direction in which the arm unit 8 opens (step S105), and whether or not the arm unit 8 has started an opening operation based on the detection value θa of the arm shaft position detection unit 74. Is determined (step S106). When this determination is NO (step S106; NO), the drive control unit 51 drives the motor until the arm unit 8 starts the opening operation.

一方、上記ステップS106の判定でアーム部8が開動作を開始したと判定された場合(ステップS106;YES)に、均衡位置測定部52は、この時点のアーム軸位置検出部74の検出値θaを、第2閉方向リミット位置として記憶部18に記憶させる(ステップS107)。   On the other hand, when it is determined in the determination in step S106 that the arm unit 8 has started the opening operation (step S106; YES), the balanced position measurement unit 52 detects the detected value θa of the arm axis position detection unit 74 at this time. Is stored in the storage unit 18 as the second closing direction limit position (step S107).

続いて、均衡位置測定部52は、第1閉方向リミット位置と第2閉方向リミット位置との平均値を算出し、算出した平均値を閉方向リミット位置として記憶部18に記憶させる(ステップS108)。   Subsequently, the equilibrium position measurement unit 52 calculates an average value of the first closing direction limit position and the second closing direction limit position, and stores the calculated average value in the storage unit 18 as the closing direction limit position (step S108). ).

続いて、駆動制御部51は、アーム部8が開く方向にモータを駆動させ(ステップS109)、アーム軸位置検出部74の検出値θaに基づいてアーム部8が停止したか否かを判定する(ステップS110)。この判定がNOである場合(ステップS110;NO)に、駆動制御部51は、アーム部8が停止するまでモータを駆動させる。   Subsequently, the drive control unit 51 drives the motor in a direction in which the arm unit 8 opens (step S109), and determines whether or not the arm unit 8 has stopped based on the detection value θa of the arm shaft position detection unit 74. (Step S110). When this determination is NO (step S110; NO), the drive control unit 51 drives the motor until the arm unit 8 stops.

一方、上記ステップS110の判定でアーム部8が停止したと判定された場合(ステップS110;YES)に、均衡位置測定部52は、この時点のアーム軸位置検出部74の検出値θaを、第1開方向リミット位置として記憶部18に記憶させる(ステップS111)。   On the other hand, when it is determined in step S110 that the arm unit 8 has stopped (step S110; YES), the equilibrium position measurement unit 52 determines the detected value θa of the arm axis position detection unit 74 at this time as the first value. The first opening direction limit position is stored in the storage unit 18 (step S111).

続いて、駆動制御部51は、アーム部8が閉じる方向にモータを駆動させ(ステップS112)、アーム軸位置検出部74の検出値θaに基づいてアーム部8が閉動作を開始したか否かを判定する(ステップS113)。この判定がNOである場合(ステップS113;NO)に、駆動制御部51は、アーム部8が閉動作を開始するまでモータを駆動させる。   Subsequently, the drive control unit 51 drives the motor in a direction in which the arm unit 8 is closed (step S112), and whether or not the arm unit 8 has started a closing operation based on the detection value θa of the arm shaft position detection unit 74. Is determined (step S113). When this determination is NO (step S113; NO), the drive control unit 51 drives the motor until the arm unit 8 starts the closing operation.

一方、上記ステップS113の判定でアーム部8が閉動作を開始したと判定された場合(ステップS113;YES)に、均衡位置測定部52は、この時点のアーム軸位置検出部74の検出値θaを、第2開方向リミット位置として記憶部18に記憶させる(ステップS114)。   On the other hand, when it is determined in step S113 that the arm unit 8 has started the closing operation (step S113; YES), the balanced position measurement unit 52 detects the detected value θa of the arm axis position detection unit 74 at this time. Is stored in the storage unit 18 as the second opening direction limit position (step S114).

続いて、均衡位置測定部52は、第1開方向リミット位置と第2開方向リミット位置との平均値を算出し、算出した平均値を開方向リミット位置として記憶部18に記憶させる(ステップS115)。   Subsequently, the equilibrium position measurement unit 52 calculates an average value of the first opening direction limit position and the second opening direction limit position, and stores the calculated average value in the storage unit 18 as the opening direction limit position (step S115). ).

続いて、均衡位置測定部52は、上記ステップS108で記憶させた閉方向リミット位置と、上記ステップS115で記憶させた開方向リミット位置とを用い、アーム部8の可動範囲を決定する(ステップS116)。   Subsequently, the equilibrium position measurement unit 52 determines the movable range of the arm unit 8 using the closing direction limit position stored in step S108 and the opening direction limit position stored in step S115 (step S116). ).

このように、アーム部8の可動範囲を求めておくことで、アーム部8を動作させるたびにアーム部8が可動範囲を超えてストッパ部材等に衝突してしまう事態を回避することが可能となる。   Thus, by obtaining the movable range of the arm portion 8, it is possible to avoid a situation in which the arm portion 8 exceeds the movable range and collides with a stopper member or the like every time the arm portion 8 is operated. Become.

なお、この動作例では、アーム部8のリミット位置として、第1リミット位置と第2リミット位置との平均値を用いているが、第1リミット位置か第2リミット位置のいずれか一方をアーム部8のリミット位置としてもよい。   In this operation example, the average value of the first limit position and the second limit position is used as the limit position of the arm unit 8, but one of the first limit position and the second limit position is used as the arm unit. The limit position may be 8.

次に、図10を参照して、アーム軸82aと出力軸75aとの均衡時における位置関係を測定する際の動作について説明する。   Next, with reference to FIG. 10, the operation | movement at the time of measuring the positional relationship at the time of the equilibrium of the arm shaft 82a and the output shaft 75a is demonstrated.

最初に、駆動制御部51は、モータを駆動してアーム部8を開方向リミット位置に移動させる(ステップS201)。   First, the drive control unit 51 drives the motor to move the arm unit 8 to the open direction limit position (step S201).

続いて、駆動制御部51は、アーム部8が閉じる方向にモータを駆動させる(ステップS202)。   Subsequently, the drive control unit 51 drives the motor in a direction in which the arm unit 8 is closed (step S202).

続いて、均衡位置測定部52は、同時点の駆動機構位置検出部72の検出値θmとアーム軸位置検出部74の検出値θaとを組にして記憶部18に記憶させる(ステップS203)。   Subsequently, the equilibrium position measurement unit 52 sets the detection value θm of the drive mechanism position detection unit 72 at the same point and the detection value θa of the arm shaft position detection unit 74 as a set and stores them in the storage unit 18 (step S203).

続いて、駆動制御部51は、アーム軸位置検出部74の検出値θaに基づいてアーム部8が閉方向リミット位置に到達したか否かを判定する(ステップS204)。この判定がNOである場合(ステップS204;NO)には、上記ステップS202に処理を移行する。   Subsequently, the drive control unit 51 determines whether or not the arm unit 8 has reached the closing direction limit position based on the detection value θa of the arm shaft position detection unit 74 (step S204). If this determination is NO (step S204; NO), the process proceeds to step S202.

一方、上記ステップS204の判定でアーム部8が閉方向リミット位置に到達したと判定された場合(ステップS204;YES)に、駆動制御部51は、モータの駆動を停止させる(ステップS205)。   On the other hand, when it is determined in step S204 that the arm unit 8 has reached the closing direction limit position (step S204; YES), the drive control unit 51 stops driving the motor (step S205).

続いて、均衡位置測定部52は、記憶部18に記憶させた検出値θmと検出値θaとの各組に基づいて、θmとθaとの相関関係を表す関数“θm=f(θa)”を算出し、この関数を記憶部18に記憶させる(ステップS206)。   Subsequently, the equilibrium position measuring unit 52 uses a function “θm = f (θa)” representing the correlation between θm and θa based on each set of the detected value θm and the detected value θa stored in the storage unit 18. And this function is stored in the storage unit 18 (step S206).

なお、この動作例では、モータを駆動させながら均衡時の位置関係を測定しているが、均衡時の位置関係を測定する際に各測定点でモータの駆動を停止させてもよい。各測定点でモータの駆動を停止させることで、均衡時の位置関係を測定する際の精度を向上させることができる。   In this operation example, the positional relationship at equilibrium is measured while driving the motor. However, when measuring the positional relationship at equilibrium, the driving of the motor may be stopped at each measurement point. By stopping the driving of the motor at each measurement point, it is possible to improve the accuracy when measuring the positional relationship at the time of equilibrium.

また、この動作例では、アーム部8が閉じる方向にモータを駆動させながら均衡時の位置関係を測定しているが、アーム部8が開く方向にモータを駆動させながら均衡時の位置関係を測定してもよい。ただし、アーム部8が閉じる方向にモータを駆動させながら均衡時の位置関係を測定した方が、アーム部8が開く方向にモータを駆動させながら均衡時の位置関係を測定した場合よりも高精度に測定することができる。アーム部8が閉じる方向にモータを駆動させた方が、弾性体73の状態が本来の均衡状態により近づくためである。   In this operation example, the positional relationship at the time of equilibrium is measured while driving the motor in the direction in which the arm portion 8 is closed, but the positional relationship at the time of equilibrium is measured while driving the motor in the direction in which the arm portion 8 is opened. May be. However, measuring the positional relationship at equilibrium while driving the motor in the closing direction of the arm unit 8 is more accurate than measuring the positional relationship at equilibrium while driving the motor in the opening direction of the arm unit 8. Can be measured. This is because the state of the elastic body 73 is closer to the original equilibrium state when the motor is driven in the direction in which the arm portion 8 is closed.

また、均衡時の位置関係の測定点を、特定のアーム軸の位置に対する測定点に限定し、測定点間の値を直線的に補完することで関数“θm=f(θa)”を算出してもよい。これにより、測定精度が低い場合に生じ得る測定値のばらつきを抑えることができるため、制御時の安定性を向上させることができる。   Further, the function “θm = f (θa)” is calculated by limiting the measurement point of the positional relationship at the time of equilibrium to the measurement point with respect to the position of the specific arm axis and linearly complementing the value between the measurement points. May be. As a result, variations in measured values that can occur when the measurement accuracy is low can be suppressed, so that stability during control can be improved.

次に、図11を参照して、アーム部8を開閉する際の動作について説明する。   Next, with reference to FIG. 11, the operation | movement at the time of opening and closing the arm part 8 is demonstrated.

最初に、駆動制御部51は、駆動機構位置検出部72の検出値θmが目標位置の値よりも大きな値であるか否かを判定する(ステップS301)。この判定がYESである場合(ステップS301;YES)に、駆動制御部51は、アーム部8が開く方向にモータを駆動させ(ステップS302)、処理を上記ステップS301に移行する。   First, the drive control unit 51 determines whether or not the detection value θm of the drive mechanism position detection unit 72 is larger than the target position value (step S301). When this determination is YES (step S301; YES), the drive control unit 51 drives the motor in a direction in which the arm unit 8 opens (step S302), and the process proceeds to step S301.

一方、上記ステップS301の判定で検出値θmが目標位置の値よりも大きな値ではないと判定された場合(ステップS301;NO)に、駆動制御部51は、駆動機構位置検出部72の検出値θmが目標位置の値よりも小さな値であるか否かを判定する(ステップS303)。この判定がYESである場合(ステップS303;YES)に、駆動制御部51は、アーム部8が閉じる方向にモータを駆動させ(ステップS304)、処理を上記ステップS301に移行する。   On the other hand, when it is determined in step S301 that the detection value θm is not larger than the target position value (step S301; NO), the drive control unit 51 detects the detection value of the drive mechanism position detection unit 72. It is determined whether or not θm is smaller than the target position value (step S303). When this determination is YES (step S303; YES), the drive control unit 51 drives the motor in a direction in which the arm unit 8 is closed (step S304), and the process proceeds to step S301.

一方、上記ステップS303の判定で検出値θmが目標位置の値よりも小さな値ではないと判定された場合(ステップS303;NO)に、駆動制御部51は、モータの駆動を停止させ(ステップS305)、処理を上記ステップS301に移行する。   On the other hand, when it is determined in step S303 that the detected value θm is not smaller than the target position (step S303; NO), the drive control unit 51 stops driving the motor (step S305). ), The process proceeds to step S301.

次に、図12を参照して、アーム81の種別を判定する際の動作について説明する。この動作は、アーム81を取り付けた後に行う。   Next, with reference to FIG. 12, an operation for determining the type of the arm 81 will be described. This operation is performed after the arm 81 is attached.

最初に、駆動制御部51は、モータを駆動してアーム部8を閉方向リミット位置に移動させる(ステップS401)。   First, the drive control unit 51 drives the motor to move the arm unit 8 to the closing direction limit position (step S401).

続いて、駆動制御部51は、アーム部8が開く方向にモータの駆動を急加速させて(ステップS402)から、モータの駆動を急停止させる(ステップS403)。   Subsequently, the drive control unit 51 suddenly accelerates the drive of the motor in the direction in which the arm unit 8 opens (step S402), and then suddenly stops the drive of the motor (step S403).

続いて、アーム種別判定部54は、モータを急停止させた後の駆動機構位置検出部72の検出値θmとアーム軸位置検出部74の検出値θaとの変化の相関関係に基づいて、特徴点を算出する(ステップS404)。   Subsequently, the arm type determination unit 54 is based on the correlation between changes in the detection value θm of the drive mechanism position detection unit 72 and the detection value θa of the arm shaft position detection unit 74 after the motor is suddenly stopped. A point is calculated (step S404).

続いて、アーム種別判定部54は、上記ステップS404で算出した特徴点の特性と、予め記憶部18に記憶されている既知のアームの特徴点の特性とを比較して、アーム81の種別を判定する(ステップS405)。   Subsequently, the arm type determination unit 54 compares the characteristic of the feature point calculated in step S404 with the characteristic of the feature point of the known arm stored in advance in the storage unit 18, and determines the type of the arm 81. Determination is made (step S405).

このように、アーム81の種別を、上記特徴点の特性に基づいて判定することで、アーム81の種別を認識させるためのスイッチやセンサを不要にすることが可能となる。   Thus, by determining the type of the arm 81 based on the characteristics of the feature points, it becomes possible to eliminate the need for a switch or sensor for recognizing the type of the arm 81.

以上のように、本実施形態における景品取得ゲーム装置100の物体把持装置5によれば、弾性体73が駆動機構70とアーム部8とを連結するため、駆動機構70のモータから付与される力によって変形する弾性体73がアーム部8に力を与えることでアーム部8に開閉動作を行わせることができる。具体的には、アーム81の自重を加味して測定された均衡位置を基準にしてアーム部8の動作を制御することで、アーム81の自重による把持力を打ち消した状態でアーム部8を開閉させることが可能となる。また、均衡位置に所望の把持力値pを加えて制御することができるため、アームの自重による把持力よりも弱い把持力から、強い把持力まで、様々な強さの把持力を自在に発生させることが可能となる。   As described above, according to the object gripping device 5 of the prize acquisition game device 100 according to the present embodiment, the elastic body 73 connects the drive mechanism 70 and the arm unit 8, and thus the force applied from the motor of the drive mechanism 70. The elastic body 73 that deforms by applying a force to the arm portion 8 can cause the arm portion 8 to open and close. Specifically, by controlling the operation of the arm unit 8 based on the measured equilibrium position with the weight of the arm 81 taken into account, the arm unit 8 is opened and closed with the gripping force due to the weight of the arm 81 being canceled. It becomes possible to make it. In addition, since the desired gripping force value p can be added to the equilibrium position and controlled, gripping force of various strengths can be freely generated from gripping force weaker than the gripping force due to the weight of the arm to strong gripping force. It becomes possible to make it.

これにより、アーム軸82aの位置および出力軸75aの位置に基づいてモータの駆動を制御することができるため、位置制御を行うことでアーム部8に開閉動作を行わせることができる。それゆえに、トルク制御に必要なモータよりも安価な、例えばステッピングモータやDCモータを使用することが可能となる。また、トルク制御に用いることができない、例えば超音波モータ等の電動機を使用することも可能となる。   Thereby, since the drive of the motor can be controlled based on the position of the arm shaft 82a and the position of the output shaft 75a, the arm unit 8 can be opened and closed by performing the position control. Therefore, it is possible to use, for example, a stepping motor or a DC motor that is less expensive than a motor required for torque control. It is also possible to use an electric motor such as an ultrasonic motor that cannot be used for torque control.

また、モータ77の軸の慣性モーメントがアーム軸82aに与える影響を低減することができるため、慣性モーメントの大きいモータを使用することも可能となる。さらに、モータ駆動時に発生する微振動を弾性体73である程度吸収することができるため、精度の低いモータを使用した場合であっても、アーム部8側への影響を抑制することが可能となる。   Further, since the influence of the moment of inertia of the shaft of the motor 77 on the arm shaft 82a can be reduced, it is possible to use a motor having a large moment of inertia. Further, since the elastic body 73 can absorb the slight vibration generated when the motor is driven to some extent, the influence on the arm portion 8 side can be suppressed even when a low-precision motor is used. .

なお、上述した実施形態では、2本のアーム部8を備えているが、アーム部の本数はこれに限定されず、1本や3本以上のアーム部を備えることとしてもよい。   In addition, in embodiment mentioned above, although the two arm parts 8 are provided, the number of arm parts is not limited to this, It is good also as providing one or three or more arm parts.

1…基台、2…収容部、5…物体把持装置、6…支持部、7…ベース部、8…アーム部、18…記憶部、50…制御部、51…駆動制御部、52…均衡位置測定部、53…均衡位置推定部、54…アーム種別判定部、55…稼働制御部、70…駆動機構、71…ギアボックス、72…駆動機構位置検出部、73…弾性体、74…アーム軸位置検出部、75…ギア、75a…出力軸、77…モータ、81…アーム、82…基端部、82a…アーム軸、82b…弾性体固定部、83…爪、100…景品取得ゲーム装置。   DESCRIPTION OF SYMBOLS 1 ... Base, 2 ... Storage part, 5 ... Object gripping device, 6 ... Support part, 7 ... Base part, 8 ... Arm part, 18 ... Memory | storage part, 50 ... Control part, 51 ... Drive control part, 52 ... Balance Position measuring unit, 53 ... balanced position estimating unit, 54 ... arm type determining unit, 55 ... operation control unit, 70 ... driving mechanism, 71 ... gear box, 72 ... driving mechanism position detecting unit, 73 ... elastic body, 74 ... arm Shaft position detection unit, 75 ... gear, 75a ... output shaft, 77 ... motor, 81 ... arm, 82 ... base end, 82a ... arm shaft, 82b ... elastic body fixing unit, 83 ... claw, 100 ... premium acquisition game device .

Claims (13)

可動式のベース部に取り付け可能であり、物体を把持するためのアームを含む、1つまたは複数のアーム部と、
前記1つまたは複数のアーム部に対応する1つまたは複数の駆動機構と、
前記アーム部と前記駆動機構とを連結する弾性体と、
前記アーム部が回動する際のアーム軸の位置を検出するアーム軸位置検出部と、
前記駆動機構の位置を検出する駆動機構位置検出部と、
前記アーム軸の位置および前記駆動機構の位置に基づいて、前記駆動機構の駆動を制御する駆動制御部と、
を備えることを特徴とする物体把持装置。
One or more arm portions that are attachable to a movable base portion and include an arm for gripping an object;
One or more drive mechanisms corresponding to the one or more arm portions;
An elastic body connecting the arm part and the drive mechanism;
An arm axis position detection unit for detecting the position of the arm axis when the arm part rotates;
A drive mechanism position detector for detecting the position of the drive mechanism;
A drive control unit that controls the drive of the drive mechanism based on the position of the arm shaft and the position of the drive mechanism;
An object gripping device comprising:
前記駆動制御部は、予め測定した前記アーム軸の位置に対して均衡する前記駆動機構の出力軸の位置である均衡位置を用いて前記駆動機構の駆動を制御し、前記弾性体は、前記駆動機構の駆動に応じて変形し、前記アーム部は、前記弾性体の変形により付加される力で把持力を発生させることを特徴とする請求項1記載の物体把持装置。   The drive control unit controls the drive of the drive mechanism using an equilibrium position that is a position of the output shaft of the drive mechanism that is balanced with respect to a position of the arm shaft measured in advance, and the elastic body 2. The object gripping device according to claim 1, wherein the arm portion is deformed according to driving of a mechanism, and the arm portion generates a gripping force by a force applied by deformation of the elastic body. 前記駆動制御部は、前記駆動機構の出力軸の目標位置として、前記均衡位置に予め設定した値を加えた位置を設定し、前記駆動機構の駆動を制御することを特徴とする請求項2記載の物体把持装置。   3. The drive control unit sets a position obtained by adding a preset value to the balanced position as a target position of an output shaft of the drive mechanism, and controls driving of the drive mechanism. Object gripping device. 前記予め設定した値は、前記アーム軸の複数の位置ごとに設定することを特徴とする請求項3記載の物体把持装置。   4. The object gripping apparatus according to claim 3, wherein the preset value is set for each of a plurality of positions of the arm shaft. 前記均衡位置を測定する均衡位置測定部を、さらに備え、
前記均衡位置測定部は、前記アーム部の回動が停止する位置を用いて前記アーム部の可動範囲を決定し、前記アーム部の可動範囲内における前記均衡位置を測定することを特徴とする請求項2〜4のいずれかに記載の物体把持装置。
An equilibrium position measuring unit for measuring the equilibrium position;
The balanced position measuring unit determines a movable range of the arm unit using a position where the rotation of the arm unit stops, and measures the balanced position within the movable range of the arm unit. Item 5. The object gripping apparatus according to any one of Items 2 to 4.
前記均衡位置測定部は、前記アームが異なる種別に交換されるたびに前記均衡位置を測定することを特徴とする請求項5記載の物体把持装置。   6. The object gripping apparatus according to claim 5, wherein the balanced position measuring unit measures the balanced position every time the arm is exchanged for a different type. 前記アーム部の可動範囲内における前記均衡位置に基づいて、前記アーム部の可動範囲外における前記均衡位置を推定する均衡位置推定部を、さらに備えることを特徴とする請求項5または6記載の物体把持装置。   The object according to claim 5, further comprising a balanced position estimating unit that estimates the balanced position outside the movable range of the arm unit based on the balanced position within the movable range of the arm unit. Gripping device. 前記アーム部の回動動作を急変動させた後の前記アーム軸の位置変化の特性を算出し、予め記憶した既知の前記アームの前記位置変化の特性と比較して前記アームの種別を判定するアーム種別判定部を、さらに備えることを特徴とする請求項1〜7のいずれかに記載の物体把持装置。   The characteristics of the position change of the arm shaft after suddenly changing the pivoting operation of the arm portion are calculated, and the type of the arm is determined by comparing with the previously stored characteristics of the position change of the arm. The object gripping device according to claim 1, further comprising an arm type determination unit. 前記アームの種別に基づいて、少なくとも前記ベース部の稼働範囲、稼働速度または稼働方式のいずれか一つを変更する稼働制御部を、さらに備えることを特徴とする請求項8記載の物体把持装置。   9. The object gripping apparatus according to claim 8, further comprising an operation control unit that changes at least one of an operation range, an operation speed, and an operation method of the base unit based on the type of the arm. 前記アーム部の回動動作を急変動させた後の前記アーム軸の位置変化の特性を算出し、前記アームの重さと重心の偏りを推定する推定部を、さらに備えることを特徴とする請求項1〜7のいずれかに記載の物体把持装置。   The apparatus further comprises an estimation unit that calculates a characteristic of a position change of the arm shaft after suddenly changing a rotation operation of the arm unit, and estimates a weight and a gravity center deviation of the arm. The object gripping device according to any one of 1 to 7. 前記アームの重さと重心の偏りに基づいて、少なくとも前記ベース部の稼働範囲、稼働速度または稼働方式のいずれか一つを変更する稼働制御部を、さらに備えることを特徴とする請求項10記載の物体把持装置。   11. The operation control unit according to claim 10, further comprising: an operation control unit that changes at least one of an operation range, an operation speed, and an operation method of the base unit based on the weight of the arm and the deviation of the center of gravity. Object gripping device. 前記駆動機構は少なくとも電動機を含み、前記駆動制御部は前記電動機の駆動を制御することを特徴とする請求項1〜11のいずれかに記載の物体把持装置。   The object gripping device according to claim 1, wherein the drive mechanism includes at least an electric motor, and the drive control unit controls driving of the electric motor. 請求項1〜12のいずれかに記載の物体把持装置を有する景品取得ゲーム装置。   A prize acquisition game device comprising the object gripping device according to claim 1.
JP2010190871A 2010-08-27 2010-08-27 Object gripping device and prize acquisition game device Active JP5786293B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2010190871A JP5786293B2 (en) 2010-08-27 2010-08-27 Object gripping device and prize acquisition game device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010190871A JP5786293B2 (en) 2010-08-27 2010-08-27 Object gripping device and prize acquisition game device

Publications (2)

Publication Number Publication Date
JP2012045204A true JP2012045204A (en) 2012-03-08
JP5786293B2 JP5786293B2 (en) 2015-09-30

Family

ID=45900794

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010190871A Active JP5786293B2 (en) 2010-08-27 2010-08-27 Object gripping device and prize acquisition game device

Country Status (1)

Country Link
JP (1) JP5786293B2 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104740868A (en) * 2013-12-27 2015-07-01 宝凯电子企业股份有限公司 Clamping jaw structure of game machine
JP2015130937A (en) * 2014-01-10 2015-07-23 寶凱電子企業股▲分▼有限公司 Game machine catcher and game machine including the same
KR20160002858U (en) * 2015-02-09 2016-08-18 김문기 Blance master game machine

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001046730A (en) * 1999-08-10 2001-02-20 Taito Corp Crane game machine
JP2002282531A (en) * 2001-03-28 2002-10-02 Japan Servo Co Ltd Game machine
JP2005028023A (en) * 2003-07-11 2005-02-03 Namco Ltd Device for gripping prize
JP2006068833A (en) * 2004-08-31 2006-03-16 Kawada Kogyo Kk Virtual spring system
JP2008246073A (en) * 2007-03-30 2008-10-16 Sega Corp Prize acquiring game machine and prize acquiring method
JP2009066157A (en) * 2007-09-12 2009-04-02 Sega Corp Prize acquisition game device

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001046730A (en) * 1999-08-10 2001-02-20 Taito Corp Crane game machine
JP2002282531A (en) * 2001-03-28 2002-10-02 Japan Servo Co Ltd Game machine
JP2005028023A (en) * 2003-07-11 2005-02-03 Namco Ltd Device for gripping prize
JP2006068833A (en) * 2004-08-31 2006-03-16 Kawada Kogyo Kk Virtual spring system
JP2008246073A (en) * 2007-03-30 2008-10-16 Sega Corp Prize acquiring game machine and prize acquiring method
JP2009066157A (en) * 2007-09-12 2009-04-02 Sega Corp Prize acquisition game device

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104740868A (en) * 2013-12-27 2015-07-01 宝凯电子企业股份有限公司 Clamping jaw structure of game machine
CN104740868B (en) * 2013-12-27 2017-12-05 宝凯电子企业股份有限公司 The clamping jaw construction of game machine
JP2015130937A (en) * 2014-01-10 2015-07-23 寶凱電子企業股▲分▼有限公司 Game machine catcher and game machine including the same
KR20160002858U (en) * 2015-02-09 2016-08-18 김문기 Blance master game machine
KR200481802Y1 (en) * 2015-02-09 2016-11-11 김문기 Blance master game machine

Also Published As

Publication number Publication date
JP5786293B2 (en) 2015-09-30

Similar Documents

Publication Publication Date Title
JP5786293B2 (en) Object gripping device and prize acquisition game device
WO2017206060A1 (en) Image stabilizing device control method and image stabilizing device
US20050218602A1 (en) Prize acquisition game device
KR101484141B1 (en) Device for testing door checker for vehicle
US11407098B2 (en) Smart push button device utilizing MEMS sensors
JP2019001380A (en) Non-contact open device of vehicle door
JP7225563B2 (en) ROBOT, CONTROL DEVICE, AND ROBOT CONTROL METHOD
JP2010527415A (en) Drive unit for moving furniture parts
JP4173158B2 (en) game machine
AU2019352672A1 (en) Monitoring system for a door of a domestic appliance and domestic appliance comprising such a system
JP3825449B2 (en) Gripping device
JP3988319B2 (en) Gripping device and prize acquisition game device
JP2017006282A (en) Performance device and game machine
JP2005230999A (en) Grip device
JP2016533845A (en) Equipment for moving furniture parts
JPH0433874Y2 (en)
KR100630356B1 (en) Mobile system and method for travelling of mobile system
JP6218939B2 (en) Device for controlling the operation of a bistable rotary solenoid motor
JP5780100B2 (en) Premium acquisition game device
JP4078193B2 (en) Balance measuring machine and balance adjusting machine
JP4270450B2 (en) Bullet ball machine
JP2015194017A (en) Faucet device
JP2019060633A (en) Vibration measurement device and vibration measurement evaluation system
JPH10197501A (en) Automatic impact exciting device
JP5549572B2 (en) External force determination parameter determination device and program, and mobile device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20130325

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20130718

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130828

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20131028

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20140715

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20140916

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20150713

R150 Certificate of patent or registration of utility model

Ref document number: 5786293

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

S531 Written request for registration of change of domicile

Free format text: JAPANESE INTERMEDIATE CODE: R313531

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250