JPS61820A - Balanced controller - Google Patents

Balanced controller

Info

Publication number
JPS61820A
JPS61820A JP12414984A JP12414984A JPS61820A JP S61820 A JPS61820 A JP S61820A JP 12414984 A JP12414984 A JP 12414984A JP 12414984 A JP12414984 A JP 12414984A JP S61820 A JPS61820 A JP S61820A
Authority
JP
Japan
Prior art keywords
moment
inertia
control device
fluid
magnetic fluid
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.)
Pending
Application number
JP12414984A
Other languages
Japanese (ja)
Inventor
Ichiro Yamazaki
一郎 山崎
Kazuo Yasuda
和男 安田
Masahiro Yonezawa
米澤 正浩
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.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric 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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP12414984A priority Critical patent/JPS61820A/en
Publication of JPS61820A publication Critical patent/JPS61820A/en
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1638Programme controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/39Robotics, robotics to robotics hand
    • G05B2219/39178Compensation inertia arms

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

PURPOSE:To attain quick control of the moment of inertia of a rotary member which holds an object to be carried, by utilizing the movement of a magnetic fluid. CONSTITUTION:When a robot hand 3 grips an object 6 to be held, the moment of inertia of a robot arm 2 is detected by a controller 12 for moment of inertia. Then the shift position of a magnetic fluid 8 is decided, and a coil 11c set at said position is energized to form a magnetic field. The fluid 8 is moved by this magnetic field and the moment of inertia of the arm 2 is kept constant. In this case, the internal pressure levels of right and left containers 7 for the fluid 8 is set equal to each other by means of a connection tube 9 during the shift of the fluid 8. Thus the fluid 8 is moved smoothly.

Description

【発明の詳細な説明】 〔発明の技術分野〕 この発明は被搬送物を保持して回動する回動部材の慣性
モーメントを制御する平衡制御装置に関するものである
DETAILED DESCRIPTION OF THE INVENTION [Technical Field of the Invention] The present invention relates to a balance control device that controls the moment of inertia of a rotating member that rotates while holding an object to be transported.

〔従来技術〕[Prior art]

従来のこの種平衡制御装置として、第1図に示すものが
あった。即ち第1図において、(1)は支持台、(2)
は支持台(1)に支持されたロボットの腕、(3)は腕
(2)に取付けられたロボットの手、(4)はロボット
制御装置、(6)は腕(2)に着脱自在に取付けられた
重錘、(6)は手(3)によって把持される被把持物で
ある。
As a conventional balance control device of this type, there is one shown in FIG. That is, in FIG. 1, (1) is the support stand, (2)
is the robot arm supported on the support base (1), (3) is the robot hand attached to the arm (2), (4) is the robot control device, and (6) is detachably attached to the arm (2). The attached weight (6) is an object to be grasped by the hand (3).

この従来のものでは、ロボット制御装置(4)によって
動作を指示されたロボットの手(3)が被゛納持物(6
)を把持し九ロボットの腕(2)が所定の位置に移動し
て後、手(3)が被把持物(6)を離して被把持物(6
)を所定の位置に搬送する。
In this conventional device, the robot's hand (3), which is instructed to operate by the robot control device (4), moves the object to be carried (6).
), and after the arm (2) of the nine robots moves to a predetermined position, the hand (3) releases the object to be grasped (6) and moves it to the object to be grasped (6).
) to the specified position.

従来の平衡制御装置は、このよりに構成されているので
、被把持物の重量に対応した慣性モーメントにすること
が必要で、一定の慣性モーメントにしなければその慣性
モーメントの違いによって腕の停止位置に差異を生ずる
欠点があった。また一定の慣性モーメントを腕に与える
ために重錘の位置をその都度調節しなければならず、調
整に時間を要する欠点があった。
Conventional balance control devices are constructed in this way, so it is necessary to set the moment of inertia to correspond to the weight of the object to be gripped.If the moment of inertia is not constant, the stopping position of the arm may vary depending on the difference in the moment of inertia. There was a drawback that caused a difference. In addition, the position of the weight must be adjusted each time in order to provide a constant moment of inertia to the arm, which has the disadvantage of requiring time for adjustment.

〔発明の概要〕[Summary of the invention]

この発明はこのような従来のものの欠点を除去するため
になされたもので、被搬送物を保持して回動する回動部
材に重錘用の磁性流体を収容した容器を取付け、この磁
性流体を移動制御する界磁発生装置を慣性モーメント制
御装置によって、被搬送物を保持した回動部材の慣性モ
ーメントに応じて制御することにより、回動部材の慣性
モーメントを迅速に制御する平衡制御装置を提供するも
のである。
This invention was made in order to eliminate such drawbacks of the conventional ones, and a container containing a magnetic fluid for a weight is attached to a rotating member that rotates while holding an object to be transported, and the magnetic fluid is The balance control device quickly controls the moment of inertia of the rotating member by controlling the field generator that controls the movement of the object using the moment of inertia control device according to the moment of inertia of the rotating member holding the transported object. This is what we provide.

〔発明の実施例〕[Embodiments of the invention]

以下この発明D−106例を第2図にもとづいて説明す
る。即ち第2図において、(7)はロボットの腕(2)
に設けられ内部に磁性流体(3)を軸方向に移動可能に
収容する容器、(9)は容器(γ)内の磁性流体をスム
ーズに流動させるための接続管、(10a)〜(10d
 )は容器())の周りに巻回配置された鉄心、(ll
a)(lla)は鉄心(10&)〜(10(1)に巻回
され通電によって発生する磁界によって容器(7)内の
磁性流体を移動させるコイル、(6)は腕(2)の慣性
モーメントを検出し所定のコイル(tta)〜(t t
a)に通電して磁性流体(3)の位置を決めるための慣
性モーメント制御装置である。
This invention D-106 example will be explained below based on FIG. 2. In other words, in Figure 2, (7) is the robot's arm (2).
(9) is a connecting pipe for smoothly flowing the magnetic fluid in the container (γ); (10a) to (10d);
) is an iron core wound around a container ()), (ll
a) (lla) is a coil wound around iron cores (10&) to (10(1)) that moves the magnetic fluid in the container (7) by the magnetic field generated by energization, and (6) is the moment of inertia of the arm (2). is detected and a predetermined coil (tta) ~ (t t
This is a moment of inertia control device for determining the position of the magnetic fluid (3) by energizing the magnetic fluid (3).

なおその他の411I或は第1図に示す従来のものと同
様であるので説明を省略する。
Note that the other parts are similar to the 411I or the conventional one shown in FIG. 1, so the explanation will be omitted.

このように構成されたものでは、ロボットの手(3)が
被把持物(6)を把持すると、ロボットの腕(2)の慣
性モーメントが慣性モーメント制御装置@によって検出
され磁性流体(3)を移動させるべき位置が決定され、
その位置にあるコイル(11G)に通電され磁界が形成
される。この磁界によって磁性流体(3)が移動しロボ
ットの腕(2)の慣性モーメントカ一定に保持される。
With this configuration, when the robot's hand (3) grasps the object to be grasped (6), the moment of inertia of the robot's arm (2) is detected by the moment of inertia controller @, and the magnetic fluid (3) is The position to move is determined,
The coil (11G) at that position is energized and a magnetic field is formed. This magnetic field moves the magnetic fluid (3) and keeps the moment of inertia of the robot arm (2) constant.

ここで磁性流体(3)の移動時に容器(7)内において
、磁性流体(3)の左右の容器(7)の内圧は接続管(
9)によって同一圧力になり磁性流体(3)はスムーズ
に移動される。
Here, when the magnetic fluid (3) is moved inside the container (7), the internal pressure of the left and right containers (7) of the magnetic fluid (3) is
9), the pressure becomes the same and the magnetic fluid (3) is moved smoothly.

なおこの実施例では、容器(7)の周りに鉄心を巻回配
置した場合を示したが、棒状の鉄心でも同様の効果が得
られる。ロボットの腕(2)の回転中心に対しロボット
の手(3)の位置する側と同じ側に慣性モーメントを調
節するための装置を設けたが、手(3)の位置する側と
逆側に設けて回転中心に対してバランスするよう調節す
るようにしても、同様の効果が得られるのみならず回転
中心となる支持台に加わる曲げモーメントや回転軸の偏
荷重を小さくすることができる。
Although this embodiment shows the case where the iron core is wound around the container (7), the same effect can be obtained with a rod-shaped iron core. A device for adjusting the moment of inertia was installed on the same side as the robot's hand (3) with respect to the center of rotation of the robot's arm (2), but on the opposite side to the side where the hand (3) is located. Even if it is provided and adjusted so as to be balanced with respect to the rotation center, not only the same effect can be obtained, but also the bending moment applied to the support base serving as the rotation center and the unbalanced load on the rotation shaft can be reduced.

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

F記のようにこの発明による平衡制御装置は、被搬送物
を保持して回動する回動部材の慣性モーメントを磁性流
体の移動によって制御するようにしたもので、迅速に制
御することができる。
As shown in item F, the balance control device according to the present invention is designed to control the moment of inertia of a rotating member that rotates while holding an object to be transported by moving a magnetic fluid, and can quickly control the moment of inertia of a rotating member that rotates while holding an object to be transported. .

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

第1図は従来のこの種平衡制御装置を示す正面図、第2
図はこの発明の一実施例を示す正面図である。 図中、(1)は支持台、(2)はロボットの腕、(3)
はロボットの手、(4)はロボット制御装置、(6)は
被把持物、(7)は容器、(3)は磁性流体、(9)は
接続管、(10&)〜(1oa)は鉄心、(lla)〜
(l ta)はコイル、@は慣性モーメント制御装置で
ある。 尚、図中同一符号は同一または相当部分を示す。
Figure 1 is a front view showing a conventional balance control device of this type;
The figure is a front view showing an embodiment of the present invention. In the figure, (1) is the support base, (2) is the robot arm, and (3)
is the robot's hand, (4) is the robot control device, (6) is the object to be grasped, (7) is the container, (3) is the magnetic fluid, (9) is the connecting pipe, (10&) to (1oa) are the iron cores. , (lla) ~
(l ta) is a coil, and @ is a moment of inertia control device. Note that the same reference numerals in the figures indicate the same or corresponding parts.

Claims (4)

【特許請求の範囲】[Claims] (1)被搬送物を保持して回動する回動部材、この回動
部材に取付けられた容器内に移動自在に収容された重錘
用の磁性流体、この磁性流体を移動制御する界磁発生装
置、この界磁発生装置を上記回動部材の慣性モーメント
に応じて制御する慣性モーメント制御装置を備えてなる
平衡制御装置。
(1) A rotating member that holds and rotates an object to be transported, a magnetic fluid for a weight movably housed in a container attached to this rotating member, and a field that controls the movement of this magnetic fluid. A balance control device comprising a generator and a moment of inertia control device that controls the field generator according to the moment of inertia of the rotating member.
(2)慣性モーメント制御装置は、被搬送物を保持した
回動部材の慣性モーメントを被搬送物の重量に無関係に
一定にするよう制御してなる特許請求の範囲第1項記載
の平衡制御装置。
(2) The balance control device according to claim 1, wherein the moment of inertia control device is configured to control the moment of inertia of a rotary member holding an object to be transported to be constant regardless of the weight of the object to be transported. .
(3)回動部材は被搬送物を把持する腕である特許請求
の範囲第1項又は第2項記載の平衡制御装置。
(3) The balance control device according to claim 1 or 2, wherein the rotating member is an arm that grips the conveyed object.
(4)界磁発生装置は互に独立した複数個の鉄心と、こ
れに巻回されたコイルとから構成されている特許請求の
範囲第1項乃至第8項のうちのいずれか1項記載の平衡
制御装置。
(4) The field generator includes a plurality of mutually independent iron cores and a coil wound around the cores, as described in any one of claims 1 to 8. balance controller.
JP12414984A 1984-06-14 1984-06-14 Balanced controller Pending JPS61820A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP12414984A JPS61820A (en) 1984-06-14 1984-06-14 Balanced controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP12414984A JPS61820A (en) 1984-06-14 1984-06-14 Balanced controller

Publications (1)

Publication Number Publication Date
JPS61820A true JPS61820A (en) 1986-01-06

Family

ID=14878145

Family Applications (1)

Application Number Title Priority Date Filing Date
JP12414984A Pending JPS61820A (en) 1984-06-14 1984-06-14 Balanced controller

Country Status (1)

Country Link
JP (1) JPS61820A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2004030872A1 (en) * 2003-03-04 2004-04-15 Necati Hacikadiroglu Balance system by fluid transfer for legged robots
CN103192408A (en) * 2013-04-03 2013-07-10 重庆绿色智能技术研究院 High-speed and high-accuracy magneto-rheological grease flexible manipulator connection rod and multi-connection-rod manipulator system
EP3479775A4 (en) * 2016-06-29 2019-09-25 Microport (Shanghai) Medbot Co., Ltd. Surgical robot and mechanical arm thereof

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2004030872A1 (en) * 2003-03-04 2004-04-15 Necati Hacikadiroglu Balance system by fluid transfer for legged robots
CN103192408A (en) * 2013-04-03 2013-07-10 重庆绿色智能技术研究院 High-speed and high-accuracy magneto-rheological grease flexible manipulator connection rod and multi-connection-rod manipulator system
EP3479775A4 (en) * 2016-06-29 2019-09-25 Microport (Shanghai) Medbot Co., Ltd. Surgical robot and mechanical arm thereof

Similar Documents

Publication Publication Date Title
EP0924689B1 (en) Control apparatus and method
CA2064094A1 (en) Magnetic bearing structure
EP1071097A4 (en) Stage positioning device
US4983869A (en) Magnetic bearing
JPH07256503A (en) Spindle apparatus
US4370004A (en) Magnetically suspended type momentum ring assembly
ES2043973T3 (en) DEVICE FOR THE REGULATION OF THE TIGHTENING FORCE OF A COIL ON A SUPPORT ROLLER.
JPS61820A (en) Balanced controller
JP4547647B2 (en) Thrust-controllable actuator
JP3330821B2 (en) Gravity compensator
CN85104531B (en) Globular rotor moment electric motor
WO1990001122A1 (en) Electromagnetic bearings
EP0049300A1 (en) A magnetically suspended type momentum ring assembly
JPH033654A (en) Articular motion actuator
Tan et al. Weighted least-norm solution based scheme for avoiding joint limits for redundant manipulators.
JPS55123836A (en) Taking-up apparatus
JPS62115188U (en)
JPH08166425A (en) Rotary mechanism for objective device in ic tester handler
JPH077887A (en) Servomotor of changeable moment of inertia of rotor
JPS63289351A (en) Active damper
JPS557707A (en) Mirror oscillation driving device
RU2028928C1 (en) Manipulator module
JPS61281310A (en) Manipulator system
JPS6058157B2 (en) zero gravity hoist
JPH04121094A (en) Torque correcting circuit for magnetic circuit