JP2004001230A - Micro robot - Google Patents

Micro robot Download PDF

Info

Publication number
JP2004001230A
JP2004001230A JP2003294922A JP2003294922A JP2004001230A JP 2004001230 A JP2004001230 A JP 2004001230A JP 2003294922 A JP2003294922 A JP 2003294922A JP 2003294922 A JP2003294922 A JP 2003294922A JP 2004001230 A JP2004001230 A JP 2004001230A
Authority
JP
Japan
Prior art keywords
motor
sensor
driving
robot
power supply
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
JP2003294922A
Other languages
Japanese (ja)
Other versions
JP3674619B2 (en
Inventor
Osamu Miyazawa
宮澤 修
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.)
Seiko Epson Corp
Original Assignee
Seiko Epson 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 Seiko Epson Corp filed Critical Seiko Epson Corp
Priority to JP2003294922A priority Critical patent/JP3674619B2/en
Publication of JP2004001230A publication Critical patent/JP2004001230A/en
Application granted granted Critical
Publication of JP3674619B2 publication Critical patent/JP3674619B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Images

Classifications

    • Y02T10/7005

Landscapes

  • Micromachines (AREA)
  • Manipulator (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide a wirelessly controllable micro robot of a size of about 1 cubic centimeter. <P>SOLUTION: The robot comprises: at least two sensors 12, 14 with their detection ranges partially overlapping; at least a pair of drive portions 28, 30 driven independently of each other and having driving points distant orthogonally with respect to a moving direction; control portions 40, 58, 60, 62 controlling the drive portions based on outputs of the sensors; and a chargeable power source 16 supplying power-supply voltage to the sensors, the drive portions and the control portions. The control portions 40, 58, 60, 62 and the power source 16 are disposed between the drive portions 28, 30 and are supported by the two driving points driven by the pair of drive portions 28, 30 with respect to the travel ground and three points of a sliding portion in sliding-friction contact with the travel ground. <P>COPYRIGHT: (C)2004,JPO

Description

 本発明は極めて小さな例えば約1立方センチメートル程度の大きさでワイヤレス制御可能なマイクロロボットに関する。 {Circle around (1)} The present invention relates to a micro robot that can be wirelessly controlled with a very small size, for example, about 1 cubic centimeter.

 従来、ロボットをワイヤレス制御する場合にはラジオコントロールと言われる制御を行っており、電波を利用した制御方式が用いられていた。また、方向を制御するためには電波に制御信号を重畳させて操舵していた。更に、自律的に所望の方向に向かわせるためには指向性を有するアンテナを用いたり、視覚センサ等を併用したりしていた。走行部には車輪を用いて走行抵抗を減らしていた。また、充電するためにの端子は剛体の接点から成り、框体の凹部に形成されていた。 Conventionally, when wirelessly controlling a robot, control called radio control has been performed, and a control method using radio waves has been used. Further, in order to control the direction, steering is performed by superimposing a control signal on a radio wave. Furthermore, in order to autonomously direct the vehicle in a desired direction, a directional antenna is used, or a visual sensor or the like is used in combination. The running part used wheels to reduce running resistance. In addition, the terminal for charging was made of a rigid contact and was formed in a recess of the frame.

 ところが、前述のロボットの制御方式では電波を利用しているため、送信側及び受信側共に多くの電気素子を必要とし、操舵のための機構が必要なことから小型化には適していなかった。また、例えば電波が発信される方向に自律的に移動させるシステムにするためには前述のアンテナやセンサを付加する必要があり、この点においても小型化には適していなかった。更に、駆動部以外の部分を車輪で支持した場合には車輪が小さいと大きな凹凸を乗り越える事ができず、逆に、車輪が大きいと小型化が困難であった。充電端子も取り扱い上小さくする事ができず、小型化の妨げになっていた。 However, since the above-described robot control method uses radio waves, many electrical elements are required on both the transmission side and the reception side, and a mechanism for steering is required, which is not suitable for miniaturization. Further, for example, in order to make the system autonomously move in the direction in which radio waves are transmitted, it is necessary to add the above-mentioned antenna and sensor, and this point is not suitable for miniaturization. Furthermore, when parts other than the drive unit are supported by wheels, if the wheels are small, it is not possible to get over large irregularities. Conversely, if the wheels are large, it is difficult to reduce the size. The charging terminal could not be made small in handling, which hindered miniaturization.

 また、そのようなロボットに何等かの作業をさせようとしても、そのような機構がまだ開発されていない状況にあった。
 更に、小形化の要請から大容量のバッテリーを取り付けることができず、ワイヤレス制御という観点からは非接触で充電することが望ましいが、そのような充電機構もまだ開発さていなという状況にあった。
Further, even if such a robot is tried to perform any operation, such a mechanism has not yet been developed.
Furthermore, a large-capacity battery cannot be installed due to the demand for miniaturization, and it is desirable to charge wirelessly from the viewpoint of wireless control, but such a charging mechanism has not yet been developed. .

 本発明の目的は、1立方センチメートル程度の大きさのマイクロロボットを提供することにある。 An object of the present invention is to provide a micro robot having a size of about 1 cubic centimeter.

 本発明の一つの態様によるマイクロロボットは、検出領域が一部重複する少なくとも2個のセンサと、互いに独立して駆動され、移動方向に対し直角方向に離れた駆動点を有する少なくとも1対の駆動部と、前記センサの出力に基づいて前記駆動部を制御する制御部と、充電可能であり、前記センサ、前記駆動部及び前記制御部に電源電圧を供給する電源部とを有し、前記制御部及び前記電源部が前記駆動部の間に配置され、前記1対の駆動部によって走行グランドに対して駆動される2つの駆動点と、走行グランドに対してすべり摩擦接触する摺動部の3点により支持される。このように構成されたことにより小形化が可能になっている。特に、センサの検出領域を重複させたことにより、簡単な回路で目標に対して自律的に移動する機能が得られる。また、駆動部がそれぞれ独立して制御されるので、簡単な機構で複雑な動作を制御することができる。また、制御部及び電源部が1対の駆動部の間に配置されているので、ロボット本体の小形化が可能になっている。更に、1対の駆動部によって走行グランドに対して駆動される2つの駆動点と、走行グランドに対して摩擦接触する摺動部の3点により支持されているので、バランスがとれて安定した走行が可能になっている。 A microrobot according to one aspect of the present invention includes at least two sensors whose detection regions partially overlap each other and at least one pair of driving units that are driven independently of each other and have driving points that are separated in a direction perpendicular to the moving direction. A control unit that controls the driving unit based on an output of the sensor, and a power supply unit that is chargeable and supplies a power supply voltage to the sensor, the driving unit, and the control unit. And a power supply unit are disposed between the driving units, and two driving points driven by the pair of driving units with respect to the traveling ground, and a sliding unit that is in sliding frictional contact with the traveling ground. Supported by points. With this configuration, miniaturization is possible. In particular, by overlapping the detection areas of the sensors, a function of autonomously moving with respect to the target with a simple circuit can be obtained. Further, since the driving units are independently controlled, complicated operations can be controlled with a simple mechanism. Further, since the control unit and the power supply unit are arranged between the pair of drive units, the robot body can be downsized. In addition, since the two driving points driven by the pair of driving units with respect to the traveling ground and the sliding portion that frictionally contacts the traveling ground are supported by three points, balanced and stable traveling is achieved. Has become possible.

 また、本発明の他の態様によるマイクロロボットにおいては、框体より突出し可撓性を有し、かつ電源部と導通している突起部を有し、該突起部に通電することにより前記電源部を充電する。突起部は摺動部として機能し、走行抵抗が減って走行性や走破性が向上するばかりでなく電源部と導通させて充電用の端子とした事により、充電の作業が容易になったと共に、電源部に応力を集中させて破壊してしまう事がなくなった。 Further, in a micro robot according to another aspect of the present invention, the micro robot has a protrusion protruding from the frame body and having flexibility and being electrically connected to a power supply unit. Charge. The protruding part functions as a sliding part, which not only reduces running resistance and improves running and running performance, but also makes charging work easier by connecting it to the power supply and using it as a charging terminal. This eliminates the possibility that the stress is concentrated on the power supply and the power supply is broken.

 図1は本発明の一実施例のマイクロロボットの側面図であり、図2はその上面図である。ロボット本体10の正面部には図示のように1対のセンサ12,14が設けられている。このセンサ12,14には例えばフォトダイオード、フォトトランジスタ等からなる光センサや、音波を圧電素子により電圧に変換する超音波センサ等が用いられるが、この実施例においてはフォトトランジスタを用いるものとする。そして、センサ12は検出領域としての視野A1を有し、センサ14も検出領域としての視野A2を有しており、両視野A1,A2はその中央部で重複しており、両センサ12,14は重複した視野A3を有する。従って、光源からの光が正面即ち視野A3にあるときには、両センサ12,14がその光を検出することになる。なお、センサ12はロボット本体10の左側に配置されているので後述する図面のフローチャートにおいてはLセンサと記述し、また、センサ14はロボット本体10の右側に配置されているので同様にしてRセンサと記述する。 FIG. 1 is a side view of a micro robot according to one embodiment of the present invention, and FIG. 2 is a top view thereof. A pair of sensors 12 and 14 are provided on the front part of the robot body 10 as shown in the figure. As the sensors 12 and 14, for example, an optical sensor including a photodiode, a phototransistor, or the like, an ultrasonic sensor that converts a sound wave into a voltage by a piezoelectric element, or the like is used. In this embodiment, a phototransistor is used. . The sensor 12 has a field of view A1 as a detection area, and the sensor 14 also has a field of view A2 as a detection area. The two fields of view A1 and A2 overlap at the center thereof. Has an overlapping field of view A3. Therefore, when the light from the light source is in front, that is, in the field of view A3, both the sensors 12, 14 detect the light. Since the sensor 12 is disposed on the left side of the robot main body 10, it will be described as an L sensor in the flow charts of the drawings described later. Further, since the sensor 14 is disposed on the right side of the robot main body 10, an R sensor is similarly provided. It is described.

 図3は図1の底面図である。電源部16が中央部分に配置されており、これは例えば電気二重層コンデンサ、ニッケルカドニウム電池等からなる。この電源部16に近接して回路部22が設けられている。この回路部22は回路基板23に実装したCMOS−IC24、プルダウン用のチップ抵抗26等を含んでおり、その詳細は後述する。駆動部28,30はそれぞれステップモータ及び減速機構を内蔵し、回路部22により制御され、これらのステップモータ及び減速機構を介して、出力軸32,34と嵌合した車輪36,38を回転駆動する。車輪36,38は外周にゴムが取り付けられている。なお、車輪36,38の形状は円形に限られず、その用途に応じて三角形、四角形等の種々の形状を取り得る。 FIG. 3 is a bottom view of FIG. A power supply unit 16 is disposed in the center, and is composed of, for example, an electric double layer capacitor, a nickel cadmium battery, or the like. A circuit section 22 is provided near the power supply section 16. The circuit section 22 includes a CMOS-IC 24 mounted on a circuit board 23, a chip resistor 26 for pull-down, and the like, the details of which will be described later. The drive units 28 and 30 each have a built-in step motor and a speed reduction mechanism, and are controlled by the circuit unit 22. The wheels 36 and 38 fitted to the output shafts 32 and 34 are rotationally driven via the step motor and the speed reduction mechanism. I do. The wheels 36 and 38 have rubber attached to the outer periphery. The shape of the wheels 36 and 38 is not limited to a circle, but may take various shapes such as a triangle and a quadrangle depending on the application.

 スペーサ39は、框体39aに対して電源部16、回路部22及び駆動部28,30を支持している。電源部16及び回路部22は一対の駆動部28,30の間であって、両者が重なるように配置されている。従って、電源部16及び回路部22は全体の体積の割には面積を広くとれる。このため、電源部16においてはコンデンサや二次電池の内部抵抗を小さくできるので大電流が効率良く取り出せ、回路部22においては複雑な機能を有する大型のICチップの実装に有利である。更に、駆動部28,30は相互に離れた位置に配置されているので磁気的な干渉等がなくなる。 The spacer 39 supports the power supply unit 16, the circuit unit 22, and the driving units 28 and 30 with respect to the frame body 39a. The power supply section 16 and the circuit section 22 are located between the pair of driving sections 28 and 30 so that they are overlapped. Therefore, the power supply unit 16 and the circuit unit 22 can have a large area for the whole volume. For this reason, the internal resistance of the capacitor or the secondary battery can be reduced in the power supply section 16 so that a large current can be efficiently extracted, and the circuit section 22 is advantageous for mounting a large IC chip having a complicated function. Further, since the driving units 28 and 30 are arranged at positions separated from each other, there is no magnetic interference or the like.

 マイクロロボット本体10の底部には摺動部1,2が設けられており、どちから一方が走行グランド3に接している。図1の実施例においてはマイクロロボット本体10の重心Gは、車輪36が走行グランド3と接する駆動点36aの鉛直方向4に対して、わずかに図の左方(以後前方と呼ぶ)にある為、摺動部1が走行グランドに接している。 摺 動 Sliding portions 1 and 2 are provided at the bottom of the micro robot main body 10, one of which is in contact with the traveling ground 3. In the embodiment of FIG. 1, the center of gravity G of the microrobot main body 10 is slightly to the left of the drawing (hereinafter referred to as the front) with respect to the vertical direction 4 of the driving point 36a where the wheel 36 contacts the traveling ground 3. The sliding part 1 is in contact with the traveling ground.

 図4は走行グランド3が傾斜しておりロボット本体10がその斜面を登る場合を示す説明図である。ここでは、駆動部の登坂能力が限界に近いものとする。このような状況において、重心Gは鉛直方向4に対して図右側(以下後方と呼ぶ)に位置し摺動部2が走行グランド3に接している。ここで、登坂能力を向上させるには、駆動部のトルクを増すばかりでなく、摺動部の摩擦抵抗を減らし、駆動点36aの摩擦力を増す必要がある。即ち、最も駆動力を必要とする登坂においては駆動部の駆動力の反作用によりマイクロロボット本体10の前方が持ち上がろうとする力と、重心と鉛直方向の関係によると力を合わせた状態で、駆動点36aに全ての重量がかかる重心の位置が良い。換言すれば、走行グランドが平らか下り坂である場合には、重心Gは鉛直方向より前にあり、登坂能力の限界近傍で重心Gが鉛直方向より後方にある構成、即ち、走行グランド3によっては駆動点の鉛直方向4に対し重心Gが鎖交する位置関係にある事が好ましい。 FIG. 4 is an explanatory view showing a case where the traveling ground 3 is inclined and the robot body 10 climbs the slope. Here, it is assumed that the hill-climbing ability of the drive unit is close to the limit. In such a situation, the center of gravity G is located on the right side in the figure (hereinafter referred to as “rear”) with respect to the vertical direction 4, and the sliding portion 2 is in contact with the traveling ground 3. Here, in order to improve the hill-climbing ability, it is necessary not only to increase the torque of the drive unit but also to reduce the frictional resistance of the slide unit and increase the frictional force at the drive point 36a. In other words, when climbing a hill that requires the most driving force, the force that the front of the microrobot main body 10 tends to lift due to the reaction of the driving force of the driving unit and the force according to the relationship between the center of gravity and the vertical direction are combined. The position of the center of gravity where all the weight is applied to the driving point 36a is good. In other words, when the traveling ground is flat or downhill, the center of gravity G is located before the vertical direction, and the center of gravity G is located behind the vertical direction near the limit of the climbing ability, that is, depending on the traveling ground 3, It is preferable that the center of gravity G interlinks with the vertical direction 4 of the driving point.

 図5及び図6は本発明の他の実施例に係るロボット本体の側面図及び底面図である。この実施例においては充電とバランサのために触覚部18及び尾20が設けられている。この触覚部18及び尾20にはそれぞれ摺動部18a,20aが設けられ前述の摺動部1,2と同等の機能を有しているが、走行グランド3と接する位置がロボット本体10の外部にある。このため、摺動部18a,20aにかかる力が少なく、摩擦抵抗が少ない為、走行のロスが少ない。触覚部18及び尾20の端部側には曲げ部18b,20bが設けられており、走行グランドに対し滑らかに湾曲している。このような構成においては、走行グランド3に大きな凹凸があっても摺動しながら容易に走破することができる。 FIGS. 5 and 6 are a side view and a bottom view of a robot body according to another embodiment of the present invention. In this embodiment, a tactile portion 18 and a tail 20 are provided for charging and a balancer. The tactile part 18 and the tail 20 are provided with sliding parts 18a and 20a, respectively, and have the same function as the sliding parts 1 and 2 described above. It is in. For this reason, the force applied to the sliding portions 18a and 20a is small, and the frictional resistance is small, so that the running loss is small. Bending portions 18b and 20b are provided on the end portions of the tactile portion 18 and the tail 20, and are smoothly curved with respect to the running ground. In such a configuration, even if the traveling ground 3 has large irregularities, the vehicle can easily run while sliding.

 この触覚部18及び尾20は可撓性のみならず導電性をも備えており、少なくとも一方は、電気二重層コンデンサや二次電池等からなる電源部16に導通している。この様な構成においては、触覚部18又は尾20の突起部を介して電源部16を充電できるため、取り扱いが容易であるばかりでなく、可撓性があるので、応力が集中することがなく破壊されにくい。 The tactile portion 18 and the tail 20 have not only flexibility but also conductivity, and at least one of the tactile portions 18 and the tail 20 is electrically connected to the power supply portion 16 including an electric double layer capacitor, a secondary battery, or the like. In such a configuration, the power supply unit 16 can be charged via the tactile part 18 or the protrusion of the tail 20, so that it is not only easy to handle but also flexible, so that stress is not concentrated. Hard to be destroyed.

 図7は本発明のマイクロロボットの車輪34,36の側面の部分拡大図である。外周部に凹部35、凸部36を設け、ゴムやプラスチックなどの高摩擦剤35a,36aを添付している。この様な構成においてては、高摩擦剤35a,36aが硬化性を有する液状であれば、表面張力により図示の形状で硬化するため、走行グランドに対し、高摩擦剤36aの部分のみが接する。従って、マイクロロボットの荷重が集中し高摩擦剤36aが弾性変化し易くなり、大きな摩擦抵抗が得られ、登坂能力が向上する。なお、凹凸の形状は本実施例に限定するものではなく、車輪に替えてアーム等を用いた場合においても同様に接触部に高摩擦剤を添付すれば良い。 FIG. 7 is a partially enlarged view of the side surfaces of the wheels 34 and 36 of the micro robot of the present invention. A concave portion 35 and a convex portion 36 are provided on the outer peripheral portion, and high friction agents 35a and 36a such as rubber and plastic are attached. In such a configuration, if the high friction agents 35a and 36a are curable liquids, they are hardened in the shape shown in the drawing by surface tension, so that only the high friction agent 36a contacts the traveling ground. Therefore, the load of the micro robot is concentrated, and the high friction agent 36a is easily elastically changed, a large frictional resistance is obtained, and the ability to climb a hill is improved. Note that the shape of the unevenness is not limited to this embodiment, and a high friction agent may be similarly attached to the contact portion even when an arm or the like is used instead of the wheel.

 図8は回路部22の詳細を示したブロック図である。ALU、各種のレジスタ等で構成されたCPUコア40には、プログラムが格納されているROM42、そのROM42のアドレスデコーダ44、各種データが格納されるRAM46、及びそのRAM46のアドレスデコーダ48が接続されている。水晶振動子50は発振器52に接続され、発振器52の発振信号はCPUコア40にクロック信号として供給される。入出力制御回路54にはセンサ12,14の出力が入力し、それはCPUコア40に出力される。電圧調整器56は電源部16の電圧を回路部22に安定して供給するためのものである。モータ駆動制御回路58はCPUコア40との間で制御信号の授受を行い、モータ駆動回路60,62を介してステップモータ64,66を制御する。以上の各回路等の電源電圧は電源部16から供給されている。 FIG. 8 is a block diagram showing details of the circuit unit 22. As shown in FIG. A ROM 42 storing a program, an address decoder 44 of the ROM 42, a RAM 46 storing various data, and an address decoder 48 of the RAM 46 are connected to a CPU core 40 including an ALU, various registers, and the like. I have. The crystal oscillator 50 is connected to an oscillator 52, and an oscillation signal of the oscillator 52 is supplied to the CPU core 40 as a clock signal. Outputs of the sensors 12 and 14 are input to the input / output control circuit 54, which is output to the CPU core 40. The voltage regulator 56 is for stably supplying the voltage of the power supply unit 16 to the circuit unit 22. The motor drive control circuit 58 exchanges control signals with the CPU core 40 and controls the step motors 64 and 66 via the motor drive circuits 60 and 62. The power supply voltage of each of the circuits described above is supplied from the power supply unit 16.

 なお、ステップモータ64は駆動部30に内蔵されており、ロボット本体10の右側に配置されているので、後述する図面のフローチャートにおいてはRモータと記述し、また、ステップモータ66は駆動部28に内蔵されており、ロボット本体10の左側に配置されているので同様にしてLモータと記述する。 Since the step motor 64 is built in the drive unit 30 and is disposed on the right side of the robot main body 10, it is described as an R motor in a flowchart of a drawing described later, and the step motor 66 is connected to the drive unit 28. Since it is built in and arranged on the left side of the robot body 10, it is similarly described as an L motor.

 図9はセンサ12の回路図である。センサ12はホトトランジスタ12aから構成されており、このホトトランジスタ12aのエミッタに直列にプルダウン抵抗26が接続されている。ホトトランジスタ12bのエミッタから受光出力が取り出され、受光出力は入出力制御回路54にて波形整形されてCPUコア40に出力される。この回路図はセンサ12の例であるが、センサ14も全く同一の構成からなっている。 FIG. 9 is a circuit diagram of the sensor 12. The sensor 12 includes a phototransistor 12a, and a pull-down resistor 26 is connected in series to the emitter of the phototransistor 12a. The received light output is taken out from the emitter of the phototransistor 12b, and the received light output is shaped by the input / output control circuit 54 and output to the CPU core 40. Although this circuit diagram is an example of the sensor 12, the sensor 14 also has exactly the same configuration.

 図10は駆動部30の平面図であり、図11はその展開図である。ステップモータ64は励磁コイル68及び、マグネットからなるロータ70を有し、電子時計において用いられる電磁式2極ステップモータがこの実施例においては用いられている。ロータ70はピニオン72を駆動し、ピニオン72はギヤを介してピニオン74を駆動し、ピニオン74はギヤを介してピニオン76を駆動し、このようにして減速されたピニオン76は車輪38を回転駆動する。この図6及び図7の機構は電子時計の機構を適用したものである。駆動部28の機構も図6及び図7に示された機構と同一である。ステップモータ64,66は、図6及び図7に示すように、高速回転させたものを減速させて車輪を回転駆動するようにしているので駆動部30,28の小形化が図られている。更に、励磁コイル68がロータ70から離れた位置に設けられいるので、この点においても駆動部30,28の薄形化・小形化が図られている。 FIG. 10 is a plan view of the driving unit 30, and FIG. 11 is a developed view thereof. The step motor 64 has an exciting coil 68 and a rotor 70 composed of a magnet. An electromagnetic two-pole step motor used in an electronic timepiece is used in this embodiment. The rotor 70 drives the pinion 72, the pinion 72 drives the pinion 74 via a gear, and the pinion 74 drives the pinion 76 via the gear, and the pinion 76 thus decelerated drives the wheel 38. I do. 6 and 7 apply an electronic timepiece mechanism. The mechanism of the drive unit 28 is the same as the mechanism shown in FIGS. As shown in FIGS. 6 and 7, the step motors 64 and 66 are configured to reduce the size of the driving units 30 and 28 by rotating the wheels at a high speed to reduce the speed. Further, since the excitation coil 68 is provided at a position distant from the rotor 70, the drive units 30, 28 can be made thinner and smaller in this regard.

 図12は上述の実施例のロボットの基本動作例を示したタイミングチャートである。センサ12,14に光が入射しないとその出力は0Vであるが、入射するとその光量に応じた電圧を出力する。その電圧は入出力制御回路54において所望のスレッショルド電圧で波形成形され、CPUコア40に入力し、モータ駆動制御回路58は駆動回路60,62を介してステップモータ64,66に正、逆に交互に駆動パルスを供給する。従って、センサ12が受光している区間S1はステップモータ64が駆動し、車輪38が回転駆動される。センサ14が受光している区間S2はステップモータ66が駆動し、車輪36が回転駆動される。双方のセンサ12,14が受光している区間Wではステップモータ64,66が駆動し、車輪38,36が回転駆動される。 FIG. 12 is a timing chart showing a basic operation example of the robot of the above embodiment. If no light is incident on the sensors 12, 14, the output is 0V, but when incident, a voltage corresponding to the light amount is output. The voltage is shaped into a desired threshold voltage in the input / output control circuit 54 and input to the CPU core 40. The motor drive control circuit 58 alternately forwards and reverses the current to the step motors 64 and 66 via the drive circuits 60 and 62. Is supplied with a drive pulse. Therefore, in the section S1 where the sensor 12 receives light, the step motor 64 is driven, and the wheels 38 are driven to rotate. In the section S2 where the sensor 14 receives light, the step motor 66 is driven, and the wheels 36 are rotationally driven. In the section W where both sensors 12 and 14 receive light, the step motors 64 and 66 are driven, and the wheels 38 and 36 are driven to rotate.

 従って、最も単純な駆動例として、光源からの光が視野A1にあると(但し視野A3を除く)光センサ12はそれを受光し、ステップモータ64がその受光出力に応じてが車輪38をに回転させる。このとき、車輪36は停止状態になっているので、ロボット本体10は全体が左の方向に向かって旋回移動することになる。また、光源からの光が視野A2にあると(但し視野A3を除く)光センサ14はそれを受光し、ステップモータ66はその受光出力に応じて車輪36を回転させる。このとき、車輪38は停止状態になっているので、ロボット本体10は全体が右方向に向かって旋回移動することになる。更に、光源からの光が視野A3にあると光センサ12,14はそれを受光し、ステップモータ64,66はその受光出力に応じて車輪38,36を回転駆動させ、ロボット本体10は真っ直ぐ移動することになる。ロボット本体10はこのようにして制御されることにより光源に向かって移動することになる。尚、本実施例においては、センサの位置と視野の方向に対して動く駆動部の配置は一つの組み合わせを示した本実施例に限定するものではない。 Therefore, as the simplest driving example, when light from the light source is in the field of view A1 (except for the field of view A3), the optical sensor 12 receives the light, and the step motor 64 moves the wheel 38 in response to the received light output. Rotate. At this time, since the wheels 36 are in the stopped state, the entire robot body 10 turns to the left. When light from the light source is in the field of view A2 (except for the field of view A3), the optical sensor 14 receives the light, and the step motor 66 rotates the wheels 36 according to the received light output. At this time, since the wheels 38 are in a stopped state, the entire robot body 10 turns to the right. Further, when the light from the light source is in the field of view A3, the optical sensors 12 and 14 receive the light, the step motors 64 and 66 rotate the wheels 38 and 36 according to the received light output, and the robot body 10 moves straight. Will do. The robot body 10 moves toward the light source by being controlled in this manner. In the present embodiment, the arrangement of the driving unit that moves in the direction of the field of view and the position of the sensor is not limited to the present embodiment that shows one combination.

 ところで、上記の動作説明においては受光センサ12,14が受光したときには一定の速度で駆動する場合の例について説明したが、駆動開始時には加速度をつけて駆動した方が駆動力が高まる。 By the way, in the above description of the operation, an example in which the light receiving sensors 12 and 14 are driven at a constant speed when receiving light is described. However, when the driving is started, the driving force is increased by driving with acceleration.

 図13は駆動開始時に加速制御する場合の基本動作を示すフローチャートであるある。まず、CPUコア40はステップモータ64の駆動パルスのクロック周波数Rcを16Hzに設定し(S1)、次にそ駆動パルスを計数するカウンタの値Rcをリセットする(S2)。次に、センサ12からの受光出力があるかどうかを判断し(S3)、受光出力があった場合には、上記のクロック周波数Rcの駆動パルスを1パルス供給してステップモータ64を駆動し、そのときのパルスを計数する(S4)。その計数値Rnが所定値例えば15であるかどうかを判断し(S5)、15になっていなければ上述の処理(S3),(S4)を繰り返す。 FIG. 13 is a flowchart showing a basic operation when acceleration control is performed at the start of driving. First, the CPU core 40 sets the clock frequency Rc of the driving pulse of the step motor 64 to 16 Hz (S1), and then resets the value Rc of the counter that counts the driving pulse (S2). Next, it is determined whether or not there is a light receiving output from the sensor 12 (S3). If there is a light receiving output, one drive pulse of the clock frequency Rc is supplied to drive the step motor 64, The pulses at that time are counted (S4). It is determined whether or not the count value Rn is a predetermined value, for example, 15 (S5). If the count value is not 15, the above processes (S3) and (S4) are repeated.

 クロック周波数Rc(=16Hz)の駆動パルスで15パルス分駆動すると、次に、駆動パルスのクロック周波数Rcが128Hz(最大値)に達しているかどうかを判断し、その値に達していない場合には、駆動パルスのクロック周波数Rcを例えば32Hzに設定して(S7)、上述の処理を同様に繰り返す。そして、駆動パルスのクロック周波数Rcが128Hz(最大値)に達すると(S6)、それ以後はその周波数の駆動パルスで駆動する。センサ12の受光出力がなくなると(S3)、ステップモータ64を停止する(S8)。このフローチャートはセンサ12(Lセンサ)とステップモータ64(Rモータ)との関係を示したものであるが、センサ14(Rセンサ)とステップモータ66(Lモータ)との関係も全く同様である。 When driving is performed for 15 pulses with a driving pulse having the clock frequency Rc (= 16 Hz), it is determined whether the clock frequency Rc of the driving pulse has reached 128 Hz (maximum value). Then, the clock frequency Rc of the drive pulse is set to, for example, 32 Hz (S7), and the above processing is repeated in the same manner. Then, when the clock frequency Rc of the drive pulse reaches 128 Hz (maximum value) (S6), the drive is thereafter performed with the drive pulse of that frequency. When there is no light output from the sensor 12 (S3), the step motor 64 is stopped (S8). Although this flowchart shows the relationship between the sensor 12 (L sensor) and the step motor 64 (R motor), the relationship between the sensor 14 (R sensor) and the step motor 66 (L motor) is exactly the same. .

 ところで、図13のフローチャートは理解を容易にするために、センサ12とセンサ14と関係を述べなかったが、例えばセンサ14が受光状態にあってステップモータ66が駆動され、ロボット本体10が光源の方に向ていくと、センサ12も受光状態になる。このように場合にはセンサ12によって駆動されるステップモータ64の駆動状態をステップモータ66の駆動状態に一致させる必要がある。このように駆動状態を位置させなければ、ロボット本体10が光源の方に向いた時点で直線移動ができなくなる。つまり旋回移動から直線移動への移行が円滑に行われなくなる。 13 does not describe the relationship between the sensor 12 and the sensor 14 for easy understanding. For example, when the sensor 14 is in the light receiving state, the step motor 66 is driven, and the robot body 10 When the sensor 12 moves in the direction, the sensor 12 is also in a light receiving state. In such a case, the driving state of the step motor 64 driven by the sensor 12 needs to match the driving state of the step motor 66. If the driving state is not positioned in this way, the robot cannot move linearly when the robot body 10 faces the light source. That is, the transition from the turning movement to the linear movement is not performed smoothly.

 図14は上記の点を考慮した制御のフローチャートである。上述の場合と同様に、CPUコア40はステップモータ64の駆動パルスのクロック周波数Rcを16Hzに設定し(S1)、次にその駆動パルスの数を計数するカウンタの値Rcをリセットする(S2)。次に、もう一方の側のセンサ14の受光出力があるかどうかを判断する(S2a) 。センサ14の受光出力があった場合には、センサ14の側の制御系の駆動パルスのクロック周波数Lc及びカウンタの値Lnをセンサ12側の駆動パルスのクロック周波数Rc及びカウンタの値Rnとして初期設定する(S2b) 。このようにして設定した後には、図9のフローチャートと同様に処理される。なお、このフローチャートもセンサ12の制御系についての動作を示すものであるが、センサ14の制御系においても同様である。 つまり、駆動開始時に他のセンサの制御系が駆動状態にあるとその状態を初期値として取り込んで始動するようにしたので、一方のセンサにのみが受光した場合には加速しながら方向を変え、そして両方のセンサが受光するようになるとその瞬間に両制御系を同じ駆動状態にさせて直進させる。従って、旋回移動から直線移動への移行が円滑に行われ、光に対する応答性が向上する。 FIG. 14 is a flowchart of the control in consideration of the above points. As in the case described above, the CPU core 40 sets the clock frequency Rc of the drive pulse of the step motor 64 to 16 Hz (S1), and then resets the value Rc of the counter that counts the number of drive pulses (S2). . Next, it is determined whether or not there is a light reception output of the sensor 14 on the other side (S2a). When the light receiving output of the sensor 14 is present, the clock frequency Lc of the drive pulse of the control system on the sensor 14 side and the value Ln of the counter are initialized as the clock frequency Rc of the drive pulse on the sensor 12 side and the value Rn of the counter. (S2b). After setting in this way, processing is performed in the same manner as in the flowchart of FIG. Although this flowchart shows the operation of the control system of the sensor 12, the same applies to the control system of the sensor 14. In other words, if the control system of the other sensor is in the driving state at the start of driving, the state is taken as the initial value and the engine is started, so if only one sensor receives light, the direction is changed while accelerating, Then, when both sensors receive light, at that moment both control systems are brought into the same driving state to proceed straight. Accordingly, the transition from the turning movement to the linear movement is performed smoothly, and the response to light is improved.

 図15は駆動パルスの波形図である。図13及び図14のフローチャートにおいて示したように駆動開始時に加速する場合に駆動力を増すためには、例えば16Hzのクロック周波数の場合にはそのパルス幅を7.8msecとしそのパルス幅を大きくとり、周波数が高くなるに従ってそのパルス幅は小さくてすむので、32Hzのクロック周波数の場合にはそのパルス幅を6.3msec、64Hzのクロック周波数の場合にはそのパルス幅を5.9msec、128Hzのクロック周波数の場合にはそのパルス幅を3.9msecとする。このようにすることにより必要な駆動力に応じた駆動パルスを供給することができ、合理的な駆動が可能になる。 FIG. 15 is a waveform diagram of the driving pulse. As shown in the flowcharts of FIGS. 13 and 14, in order to increase the driving force when accelerating at the start of driving, for example, in the case of a clock frequency of 16 Hz, the pulse width is set to 7.8 msec, and the pulse width is set to be large. Since the pulse width can be reduced as the frequency increases, the pulse width is 6.3 msec for a clock frequency of 32 Hz, and 5.9 msec and 128 Hz for a clock frequency of 64 Hz. In the case of a frequency, the pulse width is 3.9 msec. In this manner, a drive pulse corresponding to a necessary drive force can be supplied, and rational drive can be performed.

 図16は障害物を回避する場合の処理を示すフローチャートであり、図17はその回避動作の説明図である。ここでは図示を省略するが、ロボット本体10の前部に、超音波センサ、渦電流センサ、若しくは接触センサ又はこれらの組み合わせからなる障害物センサを設けるものとする。 FIG. 16 is a flowchart showing a process for avoiding an obstacle, and FIG. 17 is an explanatory diagram of the avoiding operation. Although not shown here, an obstacle sensor composed of an ultrasonic sensor, an eddy current sensor, a contact sensor, or a combination thereof is provided at the front of the robot body 10.

 まず、その障害物センサにより障害物があるかどうかを判断する(S11) 。障害物がなければそのまま作業を続ける(又はそのまま進む)(S12) 、障害物があれば、ステップモータ64又は66を逆転する(S13) 。その状態を所定時間例えば5秒間続ける(S14) 。この時間は方向変換するに必要な時間であればよいのでこの時間に限定されるものではなく、また、移動距離を設定してもよい。その後再びその障害物センサにより障害物があるかどうかを判断する(S11) 。このような処理を繰り返すことにより障害物があった場合には方向を変換して回避するようにしている。 First, it is determined whether there is an obstacle by the obstacle sensor (S11). If there is no obstacle, the operation continues (or proceeds as it is) (S12). If there is an obstacle, the step motor 64 or 66 is reversed (S13). This state is continued for a predetermined time, for example, 5 seconds (S14). This time is not limited to this time as long as it is a time necessary for the direction change, and the moving distance may be set. Thereafter, it is again determined whether there is an obstacle by the obstacle sensor (S11). By repeating such processing, when there is an obstacle, the direction is changed to avoid the obstacle.

 図18は衝突をステップモータの誘起電圧により検出し、そして障害物を回避する場合の処理を示すフローチャートであり、図19はその回避動作の説明図である。ステップモータ64,66を駆動し(S21) 、その状態でステップモータ64が回転しているかどうかを検出し(S22) 、回転していれば次にステップモータ66が回転しているかどうかを検出する(S23) 。ステップモータ66も回転していれば障害物はないものとして作業を続ける(S24) 。なお、ステップモータ64,66の回転の有無の検出方法はモータが回転すると励磁コイル68に誘起する電圧は大きいが、回転していないと小さいことを利用する。 FIG. 18 is a flowchart showing a process for detecting a collision by an induced voltage of a step motor and avoiding an obstacle, and FIG. 19 is an explanatory diagram of the avoidance operation. The step motors 64 and 66 are driven (S21). In this state, it is detected whether the step motor 64 is rotating (S22). If it is rotating, it is detected whether the step motor 66 is rotating next. (S23). If the step motor 66 is also rotating, the operation is continued assuming that there is no obstacle (S24). The method of detecting the presence or absence of rotation of the step motors 64 and 66 utilizes the fact that the voltage induced in the exciting coil 68 is large when the motor rotates, but small when the motor is not rotating.

 図20はステップモータの回転の有無を検出する方法を示したタイミングチャートである。図示のように、ステップモータが回転状態にあるときは、駆動パルスが印加された後にロータ70が回転すると、ロータ70の回転に伴って誘起電圧が励磁コイル68に誘起され、誘起電流が流れる。その誘起電流の大きさを例えばコンパレータにより検出することにより回転状態を把握することができる。ステップモータが回転状態にないときは、駆動パルスが印加された後にロータ70が回転せず、従って誘起電圧が励磁コイル68に誘起されず、誘起電流が流れない。これにより回転状態にないことを把握することができる。 FIG. 20 is a timing chart showing a method for detecting the presence or absence of rotation of the step motor. As shown, when the rotor is rotated after the drive pulse is applied when the stepping motor is in a rotating state, an induced voltage is induced in the exciting coil 68 with the rotation of the rotor 70, and an induced current flows. By detecting the magnitude of the induced current by, for example, a comparator, the rotation state can be grasped. When the stepping motor is not in a rotating state, the rotor 70 does not rotate after the drive pulse is applied, so that no induced voltage is induced in the exciting coil 68 and no induced current flows. Thereby, it can be grasped that the vehicle is not rotating.

 ステップモータ64の回転を検出した際に回転していないものと判断された場合には(S22) 、ステップモータ64,66の駆動を停止し(S25) 、ステップモータ64,66を逆転する(S26) 。その逆転駆動状態を例えば5秒間継続し(S27) 、次に回転されていないと判断されたステップモータ64を再び駆動し(S28) 、その状態を例えば5秒間継続する(S29) 。その後最初の処理(S21) に戻る。また、ステップモータ66の回転を検出した際に回転していないものと判断された場合には(S23) 、ステップモータ64,66の駆動を停止し(S30) 、ステップモータ64,66を逆転する(S31) 。その逆転駆動状態を例えば5秒間継続し(S32) 、再びステップモータ66を駆動し(S33) 、その状態を5秒間継続する(S29) 。その後最初の処理(S21) に戻る。 If it is determined that the motor is not rotating when the rotation of the step motor 64 is detected (S22), the driving of the step motors 64 and 66 is stopped (S25), and the step motors 64 and 66 are reversed (S26). ). The reverse drive state is continued for, for example, 5 seconds (S27), and the step motor 64, which is determined not to be rotated next, is driven again (S28), and the state is continued for, for example, 5 seconds (S29). Thereafter, the process returns to the first process (S21). When it is determined that the motor is not rotating when the rotation of the step motor 66 is detected (S23), the driving of the step motors 64 and 66 is stopped (S30), and the step motors 64 and 66 are rotated in reverse. (S31). The reverse drive state is continued for, for example, 5 seconds (S32), the step motor 66 is driven again (S33), and the state is continued for 5 seconds (S29). Thereafter, the process returns to the first process (S21).

 以上のようにしてステップモータ64,66の回転の有無を検出して回転していなければその駆動を一旦停止した後に逆転し、次に、回転していないと判断されたステップモータを再び回転させるようにしている。例えばロボット本体10が壁に衝突してステップモータ66が回転していない状態が発生すると、ステップモータ64,66の駆動を一旦停止した後に逆転して後退させ、その後ステップモータ66を駆動して方向を変換する。その後ステップモータ64,66を駆動して直進させるようにしているので、障害物を回避して進むことができる。 As described above, the presence or absence of rotation of the step motors 64 and 66 is detected, and if they are not rotating, the drive is temporarily stopped and then reversed, and then the step motors that are determined not to rotate are rotated again. Like that. For example, when the robot body 10 collides with a wall and a state in which the step motor 66 is not rotating occurs, the driving of the step motors 64 and 66 is temporarily stopped, then reversed and retreated, and then the step motor 66 is driven to Is converted. Thereafter, the step motors 64 and 66 are driven to move straight ahead, so that the vehicle can proceed while avoiding obstacles.

 なお、図18のフローチャートにおいてはステップモータ64,66の双方を駆動している状態下における障害物の回避について説明したが、いずれか一方のみを駆動している場合についても同様に処理される。例えばステップモータ64が駆動している場合には、図18において処理(S21) においてステップモータ64を駆動し、その後は処理(S22) 、処理(S25) 〜(S29) を行うことにより対処できる。ステップモータ66を駆動している場合も同様であり、図18において処理(S21) においてステップモータ66を駆動し、その後は処理(S23) 、処理(S30) 〜(S33) ,(S29) を行うことにより対処できる。 In the flowchart of FIG. 18, the avoidance of the obstacle while both the step motors 64 and 66 are being driven has been described. However, the same processing is performed when only one of the step motors 64 and 66 is being driven. For example, when the step motor 64 is being driven, it can be dealt with by driving the step motor 64 in the processing (S21) in FIG. 18 and thereafter performing the processing (S22) and the processing (S25) to (S29). The same applies to the case where the step motor 66 is driven. In FIG. 18, the step motor 66 is driven in the process (S21), and thereafter, the processes (S23), (S30) to (S33), and (S29) are performed. Can be dealt with.

 図22〜図23は本発明の他の実施例に係るマイクロロボットの正面、側面及び背面をそれぞれ示した図である。ロボット本体の前部にはセンサ82a〜82dが設けられ、後部にはスクリューが84a〜84dが設けられており、液体中で駆動できるように構成されている。スクリュー84a〜84dが左右上下に4個設けられておりそれぞれステップモータにより駆動されるので、ロボット本体80を左右方向に制御ができるのは勿論、上下方向にも制御できる。 FIGS. 22 to 23 are front, side, and back views, respectively, of a microrobot according to another embodiment of the present invention. Sensors 82a to 82d are provided at the front part of the robot main body, and screws 84a to 84d are provided at the rear part, and are configured to be able to be driven in liquid. Since four screws 84a to 84d are provided in the left, right, up and down directions and each is driven by a step motor, the robot body 80 can be controlled not only in the left and right directions but also in the up and down directions.

 図1又は図5のロボットはモータが2個しかないので同一のタイミングで各モータに駆動パルスを供給するが、この実施例においてはスクリュー84a〜84dが4個設けられているのでそれを駆動するステップモータも4個必要になり、これらを同一のタイミングの駆動パルスで駆動したのでは電源部16の消耗が激しくなるので図24に示す回路によりそのタイミングをずらしている。 Since the robot of FIG. 1 or FIG. 5 has only two motors, it supplies drive pulses to each motor at the same timing. In this embodiment, since four screws 84a to 84d are provided, they are driven. Since four step motors are required, and if these are driven by drive pulses of the same timing, the power supply unit 16 will be greatly consumed, so the timing is shifted by the circuit shown in FIG.

 図24はモータ駆動回路の周辺の回路を示したブロック図である。この回路図においては、図8のモータ駆動回路60,62の他にモータ駆動回路86,88を設け、これらの駆動回路はステップモータ64,66,90,92を駆動する。そして、ステップモータ64,66,90,92はスクリュー84a〜84dを回転駆動する。この実施例においては、更にモータ駆動回路60,62,86,88の位相を制御する位相差回路94〜100を設けており、各位相差回路94〜100の位相調整角を異ならせて、モータ駆動回路60,62,86,88から同一のタイミングで駆動パルスが出力しないようにしている。 FIG. 24 is a block diagram showing peripheral circuits of the motor drive circuit. In this circuit diagram, motor drive circuits 86 and 88 are provided in addition to the motor drive circuits 60 and 62 of FIG. 8, and these drive circuits drive step motors 64, 66, 90 and 92. Then, the step motors 64, 66, 90, and 92 rotate the screws 84a to 84d. In this embodiment, phase difference circuits 94 to 100 for controlling the phases of the motor drive circuits 60, 62, 86 and 88 are further provided. The driving pulses are not output from the circuits 60, 62, 86, 88 at the same timing.

 なお、上述の実施例においてはセンサにより光を検出してその方向に進む例について説明したが、検出の対象は光だけでなく、磁気、熱(赤外線)、音、電磁波等であってもよい。また、検出対象物に進むのではなくそれから逃げるように制御することもできる。その場合には図1又は図5の実施例においてはセンサ12のオフによりステップモータ64を駆動し、そして車輪38を駆動する。センサ14のオフによりステップモータ66を駆動し、そして車輪36を駆動する。センサ12,14の双方がオンのときにはステップモータ64,66を逆転駆動し、そして車輪38,36を反転駆動することににより、ロボット本体10を後退又は退避させる。更に、2種類以上の検出対象物を用意し、一方の検出対象物に対してはそれに向かって制御し、他方の検出対象物に対してはそれから逃げるように制御すれば、きめ細かな制御が可能になる。この制御は図21〜図23のロボット本体100にも勿論適用できる。 In the above-described embodiment, an example has been described in which light is detected by a sensor and travels in that direction. However, the detection target may be not only light but also magnetism, heat (infrared rays), sound, electromagnetic waves, and the like. . It is also possible to control so as to escape from the detection target instead of proceeding to the detection target. In that case, in the embodiment of FIG. 1 or FIG. 5, the step motor 64 is driven by turning off the sensor 12, and the wheels 38 are driven. When the sensor 14 is turned off, the step motor 66 is driven, and the wheels 36 are driven. When both of the sensors 12 and 14 are ON, the stepping motors 64 and 66 are driven in the reverse direction, and the wheels 38 and 36 are driven in the reverse direction, so that the robot body 10 is retracted or retracted. Furthermore, fine control is possible by preparing two or more types of detection objects, controlling one detection object toward it, and controlling the other detection object so as to escape from it. become. This control can of course be applied to the robot main body 100 shown in FIGS.

 ロボット本体の移動方向は光等の検出対象物を基準とするだけでなく、例えば移動軌跡を予めプログラムしておいて、それに従って制御するようにしてもよい。また、外部から司令を与えてその移動軌跡を制御してもよい。更に、上述の各制御を適宜組み合わせつつ、且つ学習機能を持たせて制御するようにしてもよい。
 図25は本発明の他の実施例のマイクロロボットの上面図である。ロボット本体10の正面部には図示のように1対の方向制御センサ12,14が設けられているが、この他にロボット本体10の上部には作業制御用センサ15(図25には図示せず、図26参照)が設けられており、後述するように、この作業制御用センサ15を介して外部からの作業指令を受ける。なお、このロボット本体10の底面図は図6の実施例と同様である。
The moving direction of the robot body is not limited to a reference object such as light, but may be, for example, programmed in advance and controlled according to a moving locus. Further, a command may be given from outside to control the movement locus. Further, the above-described controls may be appropriately combined and controlled with a learning function.
FIG. 25 is a top view of a micro robot according to another embodiment of the present invention. A pair of direction control sensors 12 and 14 are provided on the front part of the robot main body 10 as shown in the figure. In addition, a work control sensor 15 (shown in FIG. 26, and receives a work command from outside via the work control sensor 15 as described later. The bottom view of the robot body 10 is the same as that of the embodiment shown in FIG.

 図26は図25の実施例の回路部22の詳細を示したブロック図である。ALU、各種のレジスタ等で構成されたCPUコア40には、プログラムが格納されているROM42、そのROM42のアドレスデコーダ44、各種データが格納されるRAM46、及びそのRAM46のアドレスデコーダ48が接続されている。水晶振動子50は発振器52に接続され、発振器52の発振信号はCPUコア40にクロック信号として供給される。入出力制御回路54には方向制御用センサ12,14及び作業制御用センサ15の出力が入力し、それはCPUコア40に出力される。モータ駆動制御回路58はCPUコア40との間で制御信号の授受を行い、モータ駆動回路60,62を介してステップモータ64,66を制御すると共に、アクチュエータ駆動回路63を介して作業用アクチュエータ67を制御する。 FIG. 26 is a block diagram showing details of the circuit section 22 of the embodiment of FIG. A ROM 42 storing a program, an address decoder 44 of the ROM 42, a RAM 46 storing various data, and an address decoder 48 of the RAM 46 are connected to a CPU core 40 including an ALU, various registers, and the like. I have. The crystal oscillator 50 is connected to an oscillator 52, and an oscillation signal of the oscillator 52 is supplied to the CPU core 40 as a clock signal. Outputs of the direction control sensors 12 and 14 and the work control sensor 15 are input to the input / output control circuit 54, and output to the CPU core 40. The motor drive control circuit 58 sends and receives control signals to and from the CPU core 40, controls the step motors 64 and 66 via the motor drive circuits 60 and 62, and controls the work actuator 67 via the actuator drive circuit 63. Control.

 なお、ステップモータ64は駆動部30に内蔵されており、ロボット本体10の右側に配置されているので、後述する図面のフローチャートにおいてはRモータと記述し、また、ステップモータ66は駆動部28に内蔵されており、ロボット本体10の左側に配置されているので同様にしてLモータと記述する。 Since the step motor 64 is built in the drive unit 30 and is disposed on the right side of the robot main body 10, it is described as an R motor in a flowchart of a drawing described later, and the step motor 66 is connected to the drive unit 28. Since it is built in and arranged on the left side of the robot body 10, it is similarly described as an L motor.

 図27は図26の回路部の制御動作を示すフローチャートである。方向制御用センサ12,14により発光しているターゲットに向って移動し、操作者の指示により作業用センサ15がその指示を受信して所定の作業をする。 FIG. 27 is a flowchart showing the control operation of the circuit section of FIG. The operator moves toward a target that emits light by the direction control sensors 12 and 14, and the work sensor 15 receives the instruction according to an instruction from the operator and performs a predetermined operation.

 まず、CPUコア40は方向制御用センサ12が受光してオンになっているかどうかを判断し(S41) 、オンになっていれば光源は左側にあるものとしてステップモータ64を駆動して車輪38を回転駆動し、左側に旋回する(S42) 。また、方向制御用センサ12がオフになっていれば(S41) 、ステップモータ64の駆動を停止する(S43) 。次に、方向制御用センサ14が受光してオンになっているかどうかを判断し(S44) 、オンになっていなけばステップモータ66の駆動を停止する(S45) 。以上の処理を繰り返して方向制御用センサ14がオンになると(S44) 、ステップモータ66を駆動する(S47) 。このように動作することによりロボット本体10は光源に向かって移動し、次に、作業制御用センサ15が受光しているかどうかを判断し(S47) 、作業制御用センサ15が受光していない状態では上述の動作を繰り返して前進する。作業制御用センサ15が受光してオンになっていると、アクチュエータ駆動動回路63により作業用アクチュエータ67を制御して所望の作業をする(S48) 。 First, the CPU core 40 determines whether or not the direction control sensor 12 is turned on by receiving light (S41). If it is turned on, the CPU 32 determines that the light source is on the left side and drives the step motor 64 to drive the wheels 38. Is rotated and turned to the left (S42). If the direction control sensor 12 is off (S41), the driving of the step motor 64 is stopped (S43). Next, it is determined whether or not the direction control sensor 14 is turned on by receiving light (S44), and if it is not turned on, the drive of the step motor 66 is stopped (S45). When the above process is repeated and the direction control sensor 14 is turned on (S44), the step motor 66 is driven (S47). By operating as described above, the robot body 10 moves toward the light source. Next, it is determined whether or not the work control sensor 15 is receiving light (S47). Then, the above operation is repeated to move forward. When the work control sensor 15 receives light and is turned on, the work drive 67 is controlled by the actuator drive dynamic circuit 63 to perform a desired work (S48).

 図28は図25及び図26において作業制御用センサ15を装備しなかった場合のの動作を示すフローチャートである。この実施例においても、まず、CPUコア40は方向制御用センサ12が受光してオンになっているかどうかを判断し(S51) 、オンになっていれば光源は左側にあるものとしてステップモータ64を駆動して車輪38を回転駆動し、左側に旋回する(S52) 。また、方向制御用センサ12がオフになっていれば(S51) 、ステップモータ64の駆動を停止する(S53) 。次に、方向制御用センサ14が受光してオンになっているかどうかを判断し(S54) 、オンになっていなけばステップモータ66の駆動を停止する(S55) 。以上の処理を繰り返して方向制御用センサ14がオンなると(S54) 、ステップモータ66を駆動する(S57) 。このように動作することによりロボット本体10は光源に向かって移動し、次に、ステップモータ64,66が回転しているかどうかを判断し(S57) 、ステップモータ64,66が回転している状態では上述の動作を繰り返して前進する。ロボット本体10が所定の個所に到達して衝突するとステップモータ64,66がその瞬間回転しなくなるので、その回転しないことをもって所定の位置に到達したものと見なして、次に、アクチュエータ駆動動回路63により作業用アクチュエータ67を制御して所望の作業をする(S58) 。 FIG. 28 is a flowchart showing the operation when the work control sensor 15 is not provided in FIGS. 25 and 26. Also in this embodiment, first, the CPU core 40 determines whether or not the direction control sensor 12 receives light and is turned on (S51). Is driven to rotate the wheels 38 and turn leftward (S52). If the direction control sensor 12 is off (S51), the driving of the step motor 64 is stopped (S53). Next, it is determined whether or not the direction control sensor 14 is turned on by receiving light (S54), and if it is not turned on, the drive of the step motor 66 is stopped (S55). When the above process is repeated and the direction control sensor 14 is turned on (S54), the step motor 66 is driven (S57). By operating as described above, the robot body 10 moves toward the light source. Next, it is determined whether or not the step motors 64 and 66 are rotating (S57). Then, the above operation is repeated to move forward. When the robot main body 10 reaches a predetermined location and collides, the step motors 64 and 66 stop rotating at that moment. Therefore, it is regarded that the robot has reached the predetermined position by not rotating. To control the work actuator 67 to perform a desired work (S58).

 なお、ステップモータ64,66が回転しているかどうかの判断は次のようにしてなされる。ステップモータが回転状態にあるときには駆動パルスが励磁コイル68に供給された後にロータ70が回転し、そのロータ70の回転に伴って誘起電圧が励磁コイル68に誘起され、誘導電流が流れる。その誘導電流の大きさをコンパレータ等により検出することにより回転状態にあることが検出される。ステップモータが回転状態にないときには、駆動パルスが供給された後にロータ70が回転せず、従って誘起電圧が励磁コイル68に誘起されない。これにより回転状態にないことが検出される。 判断 Whether the step motors 64 and 66 are rotating is determined as follows. When the stepping motor is in a rotating state, the rotor 70 rotates after a drive pulse is supplied to the exciting coil 68, and with the rotation of the rotor 70, an induced voltage is induced in the exciting coil 68 and an induced current flows. By detecting the magnitude of the induced current with a comparator or the like, it is detected that the motor is rotating. When the stepping motor is not rotating, the rotor 70 does not rotate after the drive pulse is supplied, so that no induced voltage is induced in the exciting coil 68. As a result, it is detected that the vehicle is not rotating.

 図29は回路部22の他の実施例の詳細を示すブロック図である。この実施例においてはセンサとして、受信センサ102、発信素子104及び検出素子106を入出力制御回路54に接続している。図30はそのロボット本体10の上面図であり、受信センサ102及び発信素子104が図示の位置に配置されている。この実施例においては受信センサ102により移動の指令と作業の指令とを受けるようにしており、例えば赤外線を利用してその指令(直進指令、右折指令、左折指令、後退指令、作業指令等)に応じたパターンのパルス信号等を受光センサ102に向けて出力する。検出素子106は例えばイメージセンサ、触覚センサ等から構成されており、検出素子106で検出された情報は発信素子104を用いて操作側に伝えられる。 FIG. 29 is a block diagram showing details of another embodiment of the circuit section 22. In this embodiment, the receiving sensor 102, the transmitting element 104, and the detecting element 106 are connected to the input / output control circuit 54 as sensors. FIG. 30 is a top view of the robot main body 10, in which the receiving sensor 102 and the transmitting element 104 are arranged at the illustrated positions. In this embodiment, a movement command and a work command are received by the receiving sensor 102. For example, the commands (straight-travel command, right-turn command, left-turn command, reverse command, work command, etc.) are transmitted using infrared rays. A pulse signal or the like having a corresponding pattern is output to the light receiving sensor 102. The detection element 106 includes, for example, an image sensor, a tactile sensor, and the like, and information detected by the detection element 106 is transmitted to the operation side using the transmission element 104.

 図31は図29の回路部の制御動作を示すフローチャートである。まず、受信センサ102が直進指令を操作側から受けるとCPUコア40はそれを判断して(S61) 、ステップモータ64,66を駆動し直進する(S62) 。受信センサ102が右折指令を操作側から受けるとCPUコア40はそれを判断して(S63) 、ステップモータ66を駆動し右折する(S64) 。受信センサ102が左折指令を操作側から受けるとCPUコア40はそれを判断して(S65) 、ステップモータ64を駆動し左折する(S66) 。受信センサ102が後退指令を操作側から受けるとCPUコア40はそれを判断して(S67) 、ステップモータ64,66を逆回転駆動してロボット本体10を後退させる(S68) 。いずれの移動制御指令もなかった場合にはステップモータ64,66の駆動を停止させる(S69) 。次に、CPUコア40は作業指令が入力されているかどうかを判断する(S70) 。作業指令が入力されていない場合にはそのまま終了するが、作業指令が入力されている場合にはアクチュエータ駆動回路63により作業用アクチュエータ67を制御して所望の作業を行う(S71) 。その後、CPUコア40は受信センサ102を介して発信指令が入力しているかどうかを判断し(S72) 、発信指令が入力している場合には例えば検出素子106により検出された情報を符号化して発信素子104を介して操作側に送信する(S73) 。以上の処理がサイクリックに繰り返される。 FIG. 31 is a flowchart showing the control operation of the circuit section of FIG. First, when the receiving sensor 102 receives a straight-ahead command from the operation side, the CPU core 40 determines this (S61), and drives the step motors 64 and 66 to go straight (S62). When the receiving sensor 102 receives a right turn command from the operation side, the CPU core 40 determines that (S63), and drives the step motor 66 to turn right (S64). When the receiving sensor 102 receives a left turn command from the operation side, the CPU core 40 determines that (S65), and drives the step motor 64 to turn left (S66). When the receiving sensor 102 receives a retreat command from the operation side, the CPU core 40 determines that (S67), and drives the stepping motors 64 and 66 in reverse rotation to retreat the robot body 10 (S68). If there is no movement control command, the driving of the step motors 64 and 66 is stopped (S69). Next, the CPU core 40 determines whether or not a work command has been input (S70). If the work command has not been input, the process ends as it is. If the work command has been input, the actuator drive circuit 63 controls the work actuator 67 to perform a desired work (S71). Thereafter, the CPU core 40 determines whether or not a transmission command is input via the reception sensor 102 (S72). If the transmission command is input, the CPU core 40 encodes information detected by the detection element 106, for example. The data is transmitted to the operation side via the transmitting element 104 (S73). The above processing is cyclically repeated.

 ところで、上述の作業としては各種の作業が挙げられるが、その例を示すと次のとおりである。
  (1) マイクロポンプにより薬液の吐出。
  (2) 温度、圧力、成分、画像等のセンシング。
  (3) ハンドによる作業(例えばパーツ等の運搬)。
  (4) データの記憶・送信。
  (5) マイクロロボット自体の作用(例えば穴埋め、自爆による加工、種々の機能をもったロボットが集積して働く)。
  (6) サンプルの摂取、投棄。
By the way, the above-mentioned work includes various works, and examples thereof are as follows.
(1) Discharge of chemical solution by micro pump.
(2) Sensing of temperature, pressure, components, images, etc.
(3) Work by hand (for example, transporting parts etc.).
(4) Data storage and transmission.
(5) The function of the micro robot itself (for example, filling in holes, processing by self-destruction, robots with various functions are integrated and work).
(6) Ingestion and dumping of samples.

 図32は本発明のマイクロロボットを内視鏡に適用した例を示す断面図である。この装置においては、回路部22により制御されるプランジャ110を有し、このプランジャ110はその先端部に設けられたピストン112を駆動する。マイクロポンプ114はプランジャ110及びピストン112から構成されており、このピストン112の移動により薬液116はノズル118を介して管内に吐出される。このロボットの外周側には光起電力素子120が取り付けられている。発光部からの光が光ファイバ122により導かれミラー124で反射し、それは更に管内壁126で反射して今までとは逆の経路で受光部に導かれ、内視鏡としての機能を果たす。この管内壁126で反射した光の一部は光起電素子120にも入力し、回路部22の電源部(図示せず)を充電する。なお、この実施例の構成は、図25及び図26に記載された実施例とその基本的な考え方は同一であるが、センサ12,14、車輪36,38、ステッップモータ64,66等の部材が不要になっている。 FIG. 32 is a sectional view showing an example in which the micro robot of the present invention is applied to an endoscope. The apparatus has a plunger 110 controlled by a circuit section 22, and the plunger 110 drives a piston 112 provided at a distal end thereof. The micropump 114 is composed of a plunger 110 and a piston 112, and the movement of the piston 112 causes a chemical solution 116 to be discharged into a pipe via a nozzle 118. A photovoltaic element 120 is mounted on the outer peripheral side of the robot. The light from the light emitting unit is guided by the optical fiber 122 and reflected by the mirror 124, and further reflected by the inner wall 126 of the tube, guided to the light receiving unit by a reverse path to the conventional one, and functions as an endoscope. Part of the light reflected by the inner wall 126 is also input to the photovoltaic element 120 to charge a power supply unit (not shown) of the circuit unit 22. The basic concept of the configuration of this embodiment is the same as that of the embodiment shown in FIGS. 25 and 26. However, members such as the sensors 12, 14, the wheels 36, 38, and the step motors 64, 66 are used. It is no longer needed.

 この実施例においては、回路部22にはデコーダを内蔵しており、そのデコーダは光起電力素子120の出力が接続される電源部に並列接続され、充電電流に含まれる制御信号を取り出して解析する。従って、この実施例においては、内視鏡として管内を観察しながら所望の位置で、作業指令を光ファイバ122を介して操作側から供給し、回路部22はそれを光起電素子120を介して取り込み、プランジャ110を駆動して薬液116をノズル118から吐出する。 In this embodiment, the circuit section 22 has a built-in decoder. The decoder is connected in parallel to a power supply section to which the output of the photovoltaic element 120 is connected, and extracts and analyzes a control signal included in the charging current. I do. Accordingly, in this embodiment, a work command is supplied from the operation side via the optical fiber 122 at a desired position while observing the inside of the tube as an endoscope, and the circuit unit 22 transmits the work command via the photovoltaic element 120. Then, the plunger 110 is driven to discharge the chemical solution 116 from the nozzle 118.

 図33は本発明の他の実施例に係るマイクロロボットの底面図であり、図34はその側面図である。この実施例のマイクロロボットは、図25に示されるロボット本体にマイクロポンプ130を内蔵させ、前面部にノズル132を設けたものである。この実施例においては、例えば図27のフローチャートの作業(S48) 、図28のフローチャートの作業(S58) 及び図31のフローチャートの作業(S71) において、マイクロポンプ130を駆動してノズル132から薬液を吐出する。 FIG. 33 is a bottom view of a micro robot according to another embodiment of the present invention, and FIG. 34 is a side view thereof. The micro robot of this embodiment has a micro pump 130 built in the robot main body shown in FIG. 25 and a nozzle 132 provided on the front surface. In this embodiment, for example, in the operation (S48) of the flowchart of FIG. 27, the operation (S58) of the flowchart of FIG. 28, and the operation (S71) of the flowchart of FIG. Discharge.

 図35は本発明の他の実施例に係るマイクロロボットの側面図であり、図36はその底面図である。この実施例のマイクロロボットは、図25に示されるロボット本体10にハンド機構を設けたものである。ロボット本体10の上部に上モータユニット140が設けられ、それは上ピニオン142を回転させ、上ピニオン142は上ギヤ144と係合して、軸152に回転自在に支持されている上アーム146を駆動する。ロボット本体10の下部に下モータユニット148が設けられ、それは下ピニオン149を回転させ、下ピニオン149は下ギヤ150と係合し、軸152に回転自在に支持されている下アーム154を駆動する。この上アーム146及び下アーム154はハンド156を構成している。 FIG. 35 is a side view of a micro robot according to another embodiment of the present invention, and FIG. 36 is a bottom view thereof. The microrobot of this embodiment has a hand mechanism provided on the robot body 10 shown in FIG. An upper motor unit 140 is provided on the upper portion of the robot body 10, and rotates an upper pinion 142, which engages with an upper gear 144 to drive an upper arm 146 rotatably supported on a shaft 152. I do. A lower motor unit 148 is provided at the lower portion of the robot body 10, which rotates a lower pinion 149, which engages with a lower gear 150 and drives a lower arm 154 rotatably supported on a shaft 152. . The upper arm 146 and the lower arm 154 constitute a hand 156.

 図37は図35及び図36の実施例のマイクロロボットの回路部22の詳細を示したブロック図である。この実施例は図26の回路図と基本的に同一であるが、上モータ駆動回路160及び下モータ駆動回路162が設けられている。上モータ駆動回路160は上モータユニット140に内蔵している上モータ164を駆動制御し、下モータ駆動回路162は下モータユニット148に内蔵している下モータ166を駆動制御する。なお、上モータ164及び下モータ166はステップモータで構成されいるのが望ましく、そのようにした場合には上モータ164と下モータ166とを同期して駆動するのが容易になる。 FIG. 37 is a block diagram showing details of the circuit section 22 of the micro robot of the embodiment shown in FIGS. 35 and 36. This embodiment is basically the same as the circuit diagram of FIG. 26, except that an upper motor drive circuit 160 and a lower motor drive circuit 162 are provided. The upper motor drive circuit 160 controls the drive of an upper motor 164 built in the upper motor unit 140, and the lower motor drive circuit 162 controls the drive of a lower motor 166 built in the lower motor unit 148. It is desirable that the upper motor 164 and the lower motor 166 be constituted by step motors. In such a case, it is easy to drive the upper motor 164 and the lower motor 166 synchronously.

 図38は図35〜図37の実施例のマイクロロボットの制御動作を示すフローチャートである。まず、作業制御用センサ15が制御指令を受けると、CPUコア40はその指令がア−ムを上げる指令であるかどうかを判断する(S81) 。その指令がア−ムを上げる指令であった場合には上モータ駆動回路160により上モータ164を反時計方向に回転させる(S82) 。これにより上アーム146は時計方向に回動する。次に、下モータ駆動回路162により下モータ166を反時計方向に回転させる(S83) 。これにより下アーム154は時計方向に回動する。このように上アーム146及び下アーム154を共に時計方向に回転させることによりハンド156は図39に示されるように上がる。 FIG. 38 is a flowchart showing the control operation of the micro robot of the embodiment shown in FIGS. First, when the work control sensor 15 receives a control command, the CPU core 40 determines whether the command is a command for raising the arm (S81). If the command is a command to raise the arm, the upper motor drive circuit 160 rotates the upper motor 164 counterclockwise (S82). This causes the upper arm 146 to rotate clockwise. Next, the lower motor 166 is rotated counterclockwise by the lower motor drive circuit 162 (S83). This causes the lower arm 154 to rotate clockwise. By rotating both the upper arm 146 and the lower arm 154 clockwise in this manner, the hand 156 is raised as shown in FIG.

 また、CPUコア40がア−ムを下げるという指令を受け取ると(S84) 、上モータ駆動回路160により上モータ164を時計方向に回転させる(S85) 。これにより上アーム146は反時計方向に回動する。次に、下モータ駆動回路162により下モータ166を時計方向に回転させる(S86) 。これにより下アーム154は反時計方向に回動する。このように上アーム146及び下アーム154を共に反時計方向に回転させることによりハンド156は下がる。 When the CPU core 40 receives a command to lower the arm (S84), the upper motor 164 is rotated clockwise by the upper motor drive circuit 160 (S85). As a result, the upper arm 146 rotates counterclockwise. Next, the lower motor 166 is rotated clockwise by the lower motor drive circuit 162 (S86). As a result, the lower arm 154 rotates counterclockwise. As described above, the hand 156 is lowered by rotating both the upper arm 146 and the lower arm 154 counterclockwise.

 また、CPUコア40がア−ムを開くという指令を受け取ると(S87) 、上モータ駆動回路160により上モータ164を反時計方向に回転させる(S88) 。これにより上アーム146は時計方向に回動する。次に、下モータ駆動回路162により下モータ166を時計方向に回転させる(S86) 。これにより下アーム154は反時計方向に回動する。このように上アーム146を時計方向に回転させ、下アーム154を反時計方向に回転させることにより、上アーム146と下アーム154とは図40に示されるように開く。 When the CPU core 40 receives the command to open the arm (S87), the upper motor drive circuit 160 rotates the upper motor 164 counterclockwise (S88). This causes the upper arm 146 to rotate clockwise. Next, the lower motor 166 is rotated clockwise by the lower motor drive circuit 162 (S86). As a result, the lower arm 154 rotates counterclockwise. By rotating the upper arm 146 clockwise and rotating the lower arm 154 counterclockwise in this way, the upper arm 146 and the lower arm 154 open as shown in FIG.

 また、CPUコア40がア−ムを閉じるという指令を受け取ると(S90) 、上モータ駆動回路160により上モータ164を時計方向に回転させる(S91) 。これにより上アーム146は反時計方向に回動する。次に、下モータ駆動回路162により下モータ166を反時計方向に回転させる(S92) 。これにより下アーム154は時計方向に回動する。このように上アーム146と下アーム154とを互いに接近するように制御することにより、上アーム146と下アーム154とは閉じる。 When the CPU core 40 receives a command to close the arm (S90), the upper motor drive circuit 160 rotates the upper motor 164 clockwise (S91). As a result, the upper arm 146 rotates counterclockwise. Next, the lower motor 166 is rotated counterclockwise by the lower motor drive circuit 162 (S92). This causes the lower arm 154 to rotate clockwise. By controlling the upper arm 146 and the lower arm 154 to approach each other in this way, the upper arm 146 and the lower arm 154 are closed.

 図41は本発明の他の実施例に係るマイクロロボットの概念図であり、図42はその側面図である。ロボット本体10は図示のように作業用モータ200を内蔵しており、この作業用モータ200はモータステータ202とロータ204とから構成されている。このロボット本体10は非磁性管206内に配置されており、この非磁性管206には液が入っているものとする。非磁性管206の外側にはコイルステータ208が配置され、コイルステータ208にはコイル210が巻回されている。 図43は作業モータ200の詳細を示した図である。モータステータ202には内周部に一対の内ノッチ202aが設けられ、外周部に一対の外ノッチ202bが設けられており、内ノッチ202aの位置と外ノッチ202bの位置とは図示のように周方向にずれている。ロータ204はマグネットから構成されており、N極とS極の2極に着磁されている。外部からの磁界がかけられると、図示のように磁束212がモータステータ202内を通る。 FIG. 41 is a conceptual diagram of a micro robot according to another embodiment of the present invention, and FIG. 42 is a side view thereof. The robot main body 10 has a built-in work motor 200 as shown, and this work motor 200 is composed of a motor stator 202 and a rotor 204. The robot main body 10 is disposed in a non-magnetic tube 206, and the non-magnetic tube 206 contains a liquid. A coil stator 208 is arranged outside the non-magnetic tube 206, and a coil 210 is wound around the coil stator 208. FIG. 43 is a diagram showing details of the work motor 200. The motor stator 202 is provided with a pair of inner notches 202a on the inner peripheral portion and a pair of outer notches 202b on the outer peripheral portion. The position of the inner notch 202a and the position of the outer notch 202b It is shifted in the direction. The rotor 204 is formed of a magnet, and is magnetized to two poles, an N pole and an S pole. When an external magnetic field is applied, a magnetic flux 212 passes through the motor stator 202 as shown.

 図43〜46は作業モータ200の動作原理を示す図である。図44は磁界が外部から加えられていない状態を示した図である。この状態ではロータ204のN極とS極との境界点が内ノッチ202aに対向して安定している。次に、磁界を図45のようにかけると、ロータ204は回転するが、外ノッチ202bの部分のモータステータ202の部分は狭くなっているので、強い磁界が加わると磁気飽和し、この部分での磁界は弱くなるので、ロータ204の前記の境界点は外ノッチ202bの部分で安定する。その後、磁界を外部から加えるのを停止すると、図46に示すように、ロータ204の前記境界点が内ノッチ202aに対向して安定する。このようにして図44から図46にかけてロータ204は半回転していることが分かる。次に、磁界を反対方向から供給すると、ロータ204は更に半回転する。このように磁界を交互に加えることによりロータ204は連続的に回転することになる。なお、上記の説明は半時計方向に回転させる場合の例であるが、時計方向にも同様にして回転させることができる。また、このモータの動作原理自体は上述の実施例のステップモータ64,66等にも適用される。 FIGS. 43 to 46 are diagrams illustrating the operation principle of the work motor 200. FIG. FIG. 44 shows a state where no magnetic field is applied from the outside. In this state, the boundary point between the north pole and the south pole of the rotor 204 is stable facing the inner notch 202a. Next, when a magnetic field is applied as shown in FIG. 45, the rotor 204 rotates, but the portion of the motor stator 202 at the outer notch 202b is narrowed. Therefore, when a strong magnetic field is applied, magnetic saturation occurs. , The boundary point of the rotor 204 is stabilized at the outer notch 202b. Thereafter, when the application of the magnetic field from the outside is stopped, as shown in FIG. 46, the boundary point of the rotor 204 is opposed to the inner notch 202a and stabilized. Thus, it can be seen from FIG. 44 to FIG. 46 that the rotor 204 has rotated half a turn. Next, when a magnetic field is supplied from the opposite direction, the rotor 204 further rotates a half turn. By thus alternately applying the magnetic field, the rotor 204 rotates continuously. The above description is an example of the case of rotating in the counterclockwise direction, but it is also possible to rotate in the clockwise direction. Further, the operation principle of the motor itself is applied to the step motors 64 and 66 of the above-described embodiment.

 作業用モータ200の動作原理が明らかになったところで、次に図41及び図42の装置の動作説明をする。コイル210に正・負の励磁電流を供給すると、コイルステータ208にそれに対応した磁束が発生し、その磁束は非磁性管206を通ってモータステータ202に至り、上述の動作原理によりロータ204が回転する。そのロータ204の回転によりマイクロポンプとして機能させたり、図示しないスクリューを回転させて推進したり或いは液体の流れを作ったりすることができる。或いは図示しないカッターを回転させて目的とする部分を削除したりすることもできる。 (4) Now that the operation principle of the working motor 200 has been clarified, the operation of the apparatus shown in FIGS. 41 and 42 will be described. When a positive or negative excitation current is supplied to the coil 210, a corresponding magnetic flux is generated in the coil stator 208, and the magnetic flux reaches the motor stator 202 through the non-magnetic tube 206, and the rotor 204 rotates according to the above-described operation principle. I do. The rotation of the rotor 204 can function as a micro pump, rotate a screw (not shown) for propulsion, or create a liquid flow. Alternatively, a desired portion can be deleted by rotating a cutter (not shown).

 特にこの実施例においてはコイルステータ208を非磁性管206の長さ方向に移動すると、その磁界による磁力により作業用モータ200それ自体もその移動に沿って移動する。従って、外部から磁界を加えることによりマイクロロボット本体10の位置を制御することができる。更に、外部から磁界を加えることにより作業用モータ200を駆動することができるので、マイクロロボット本体10には作業用モータ200を駆動するエネルギーを保存する手段(蓄電池)を必要としない。なお、コイルステータ208は1個ではなく、非磁性管206の長さ方向に沿って複数個設けて、複数のロボット本体10を順次駆動させるようにしてもよい。また、コイル210は単相である必要はなく、3相等の多相コイルによって構成してもよい。その場合にはモータステ−タ202等もそれに対応した構成にする。 In particular, in this embodiment, when the coil stator 208 is moved in the length direction of the non-magnetic tube 206, the work motor 200 itself moves along with the movement by the magnetic force of the magnetic field. Therefore, the position of the micro robot main body 10 can be controlled by applying a magnetic field from the outside. Furthermore, since the working motor 200 can be driven by applying a magnetic field from the outside, the microrobot main body 10 does not require a means (a storage battery) for storing energy for driving the working motor 200. Instead of one coil stator 208, a plurality of coil stators 208 may be provided along the length direction of the non-magnetic tube 206 to sequentially drive the plurality of robot bodies 10. Further, the coil 210 does not need to be a single phase, and may be constituted by a multi-phase coil such as a three-phase coil. In that case, the motor stator 202 and the like are also configured to correspond thereto.

 なお、上述の実施例のステップモータは図41の実施例を除いて、超音波モータ等によってもよい。また、必要に応じて上述の各実施例の要素を適宜組み合わせてマイクロロボットを構成してもよい。 The stepping motor of the above embodiment may be replaced by an ultrasonic motor or the like except for the embodiment of FIG. Further, a micro robot may be configured by appropriately combining the elements of the above-described embodiments as needed.

 次に、電源16に対する充電機構について説明する。 図47は電磁誘導による充電機構を付加した回路部22の詳細を示したブロック図である。モータ駆動回路62の充電回路の出力が電源部16に接続され、この電源部16には電圧調整器56が接続されている。この電圧調整器56は昇圧回路300と電圧リミッター302とから構成されている。 Next, a charging mechanism for the power supply 16 will be described. FIG. 47 is a block diagram showing details of the circuit unit 22 to which a charging mechanism by electromagnetic induction is added. The output of the charging circuit of the motor drive circuit 62 is connected to the power supply 16, to which a voltage regulator 56 is connected. The voltage regulator 56 includes a booster circuit 300 and a voltage limiter 302.

 図48はこの実施例のモータ駆動回路62の詳細を示す回路図である。モータドライバ304,306,308,310は励磁コイル68に対して図示のようにH接続され、そして、各ドライバには並列に、且つ逆方向にダイオード312,314,316,318が接続さている。また、交流磁界を検出するためのスイッチ320,322が励磁コイル68の両端に接続され、これらのスイッチ320,322が閉成されると、励磁コイル68に対して閉回路が形成される。また、励磁コイル68の両端は磁界検出用インバータ324,326に導かれ、その出力はオア回路328を介してモータ駆動制御回路58に導かれる。定常的にはドライバ304,310とドライバ308,306とが交互に駆動され励磁コイル68に励磁電流が供給されてステップモータ66が駆動されるが、充電動作時には全ドライバ304,306,308,310をオフにして、後述する充電スタンドの充電コイルからの電磁誘導を励磁コイル68が受けると、誘起電圧がダイオード312,314,316,318により整流されて電源部16に導かれて充電動作をする。なお、ドライバ304,306,308,310が図示のようにFETにより構成されていてそれに等価的に含まれるダイオードが十分機能する場合には外付けのダイオード312,314,316,318を省略することもできる。 FIG. 48 is a circuit diagram showing details of the motor drive circuit 62 of this embodiment. The motor drivers 304, 306, 308, 310 are H-connected to the exciting coil 68 as shown, and diodes 312, 314, 316, 318 are connected to the respective drivers in parallel and in opposite directions. Further, switches 320 and 322 for detecting an AC magnetic field are connected to both ends of the exciting coil 68, and when these switches 320 and 322 are closed, a closed circuit is formed for the exciting coil 68. Both ends of the exciting coil 68 are guided to the magnetic field detecting inverters 324 and 326, and the output is guided to the motor drive control circuit 58 via the OR circuit 328. Normally, the drivers 304 and 310 and the drivers 308 and 306 are alternately driven to supply an exciting current to the exciting coil 68 to drive the step motor 66. However, during the charging operation, all the drivers 304, 306, 308 and 310 are driven. Is turned off, and when the excitation coil 68 receives electromagnetic induction from a charging coil of a charging stand described later, the induced voltage is rectified by the diodes 312, 314, 316, and 318 and guided to the power supply unit 16 to perform a charging operation. . When the drivers 304, 306, 308, and 310 are constituted by FETs as shown in the figure and the diodes equivalently included therein function sufficiently, the external diodes 312, 314, 316, and 318 are omitted. You can also.

 図49は電源部16を構成している電気二重層コンデンサ334の放電特性であり、図50は電圧調整器56の詳細を示す回路説明図である。図50においては、高容量コンデンサ334及びリミッタースイッチ330を有し、更にもう1つの電源としてコンデンサ360を有している。コンデンサ334からコンデンサ360へその電圧を昇圧しながら充電する手段が破線135で囲まれた部分に示されている。コンデンサ334からコンデンサ360へ昇圧しながら充電する手段335はコンデンサ340,350とスイッチ336,338,342,344,346,348,352とから構成されている。コンデンサ360から制御部22の各部に電源電圧が供給されている。検出器332はコンデンサ334の電圧を検出する。 FIG. 49 shows the discharge characteristics of the electric double layer capacitor 334 constituting the power supply unit 16, and FIG. 50 is a circuit explanatory diagram showing details of the voltage regulator 56. FIG. 50 includes a high-capacity capacitor 334 and a limiter switch 330, and further includes a capacitor 360 as another power supply. A means for charging the capacitor 360 from the capacitor 334 while increasing its voltage is shown in a portion surrounded by a broken line 135. The means 335 for charging while boosting the voltage from the capacitor 334 to the capacitor 360 includes capacitors 340 and 350 and switches 336, 338, 342, 344, 346, 348 and 352. A power supply voltage is supplied from the capacitor 360 to each part of the control unit 22. The detector 332 detects the voltage of the capacitor 334.

 次に図50の回路の動作を説明する。
 大容量コンデンサ334がフル充電された後にその電圧が1.2V以上の時はコンデンサ334とコンデンサ360とは同じ電圧である。コンデンサ334の電圧が1.2V〜0.8Vの時は昇圧手段335により1.5倍に昇圧してコンデンサ360へ充電する。この動作は図49のt1 〜t3 の区間である。従って、この時のコンデンサ360の電圧は1.8V〜1.2Vとなる。コンデンサ334の電圧が0.8V〜0.6Vの時は昇圧手段335により2倍に昇圧されコンデンサ360に充電される。この動作図49のt3 〜t4 の区間である。この時のコンデンサ360の電圧は1.6V〜1.2Vとなる。
Next, the operation of the circuit of FIG. 50 will be described.
When the voltage of the large capacity capacitor 334 is 1.2 V or more after being fully charged, the capacitor 334 and the capacitor 360 have the same voltage. When the voltage of the capacitor 334 is between 1.2 V and 0.8 V, the voltage is boosted 1.5 times by the booster 335 and the capacitor 360 is charged. This operation is an interval of t 1 ~t 3 of Figure 49. Therefore, the voltage of the capacitor 360 at this time is 1.8 V to 1.2 V. When the voltage of the capacitor 334 is between 0.8 V and 0.6 V, the voltage is doubled by the booster 335 and the capacitor 360 is charged. Is an interval of t 3 ~t 4 of Operation Figure 49. At this time, the voltage of the capacitor 360 is 1.6 V to 1.2 V.

 コンデンサ334の電圧が0.6以下の時は昇圧手段335により3倍に昇圧してコンデンサ360に充電する。この動作は図49のt4 以降である。この状態を示したのが図49である。実線で示した電圧が図50のコンデンサ360の電圧であり破線で示した電圧がコンデンサ334の電圧である。 When the voltage of the capacitor 334 is 0.6 or less, the voltage is boosted three times by the booster 335 and the capacitor 360 is charged. This operation is t 4 later in FIG. 49. FIG. 49 shows this state. The voltage shown by the solid line is the voltage of the capacitor 360 in FIG. 50, and the voltage shown by the broken line is the voltage of the capacitor 334.

 次に昇圧手段335の動作を説明する。
 昇圧する時、まずコンデンサ334からコンデンサ340,350に充電しそれからコンデンサ334,340,350によりコンデンサ360を充電する。即ち図51〜図53に示す動作をくり返す事により昇圧充電が可能となる。
 1.5倍昇圧の時は図51の(A)、(B)
 2.0倍昇圧の時は図52の(A)、(B)
 3.0倍昇圧の時は図53の(A)、(B)に示している。
 これらの切換は図50のスイッチ336,338,342,344,346,348,352のスイッチングにより実行される。
Next, the operation of the booster 335 will be described.
When the voltage is boosted, first, the capacitors 340 and 350 are charged from the capacitor 334, and then the capacitor 360 is charged by the capacitors 334, 340 and 350. That is, boosting charging becomes possible by repeating the operations shown in FIGS.
At the time of 1.5-fold step-up, (A) and (B) of FIG.
52 (A) and (B) of FIG.
53 (A) and (B) of FIG. 53 when the voltage is boosted by 3.0 times.
These switching operations are performed by switching the switches 336, 338, 342, 344, 346, 348, and 352 in FIG.

 以上述べたようにこの実施例によれば動作可能な時間を、図49において、t2 時間からt5 時間まで伸ばしている。また、コンデンサ334の電圧で言えば従来0.9Vらか1.8Vの間でしか使えなかったものが、本実施例によれば0.3Vから1.8Vまで使うことができ、コンデンサ334に蓄えられたエネルギーが有効に使われていることが分る。 The operable time According to this embodiment as described above, in FIG. 49, are extended from t 2 hours to t 5 hours. According to the present embodiment, the voltage of the capacitor 334 can be used only between 0.9 V and 1.8 V, but according to the present embodiment, it can be used from 0.3 V to 1.8 V. You can see that the stored energy is being used effectively.

 また、この実施例では昇圧手段335が1.5倍、2.0倍、3.0倍の3種類の昇圧手段を有し、それを電圧検出部332による電圧信号により切換えて使っているが、本発明はこの3種に限定されるものではなく、1種類でも又多種類用意してもよく又倍率もさまざま考えられる。また、電圧の検出を本実施例ではコンデンサ334の電圧を検出している(1.8,1.2,0.8,0.6V)がコンデンサ360の電圧を検出して(1.8V,1.2V)、昇圧手段335の内容と比較して昇圧状態を決めることも勿論可能である。この方法は検出電圧が少なくて良いという利点がある。 In this embodiment, the boosting means 335 has three types of boosting means of 1.5 times, 2.0 times and 3.0 times, which are switched by a voltage signal from the voltage detecting unit 332 and used. The present invention is not limited to these three types, and one type or many types may be prepared, and various magnifications may be considered. In the present embodiment, the voltage of the capacitor 334 is detected (1.8, 1.2, 0.8, 0.6 V), but the voltage of the capacitor 360 is detected (1.8 V, 1.2 V), it is of course possible to determine the boosted state in comparison with the contents of the boosting means 335. This method has an advantage that the detection voltage may be small.

 図54は上述のマイクロロボットに適用される充電スタンドの斜視図である。図示のように、例えば赤外線を放射する信号発生装置370の近傍にはエネルギー供給装置372が設置されており、エネルギー供給装置372の上部には充電エリア374が形成されている。 FIG. 54 is a perspective view of a charging stand applied to the above-mentioned micro robot. As shown in the figure, for example, an energy supply device 372 is installed near a signal generator 370 that emits infrared light, and a charging area 374 is formed above the energy supply device 372.

 図55はエネルギー供給装置372の構成を示すブロック図である。発振器376の出力は増幅器378により増幅されて充電コイル380を励磁する。この充電コイル380の励磁電流の周波数はステップモータの追随可能な周波数よりも高い周波数に設定しておく。 FIG. 55 is a block diagram showing a configuration of the energy supply device 372. The output of oscillator 376 is amplified by amplifier 378 to excite charging coil 380. The frequency of the exciting current of the charging coil 380 is set to a frequency higher than the frequency that the step motor can follow.

 図56は自動充電時の動作を示すフローチャートである。CPUコア40は電源部16の電圧値を取り込み、それが所定の基準電圧より高いかどうかを判断し(S111)、高い場合には通常の動作を継続する(S112)。電源部16の電圧が所定の基準電圧VL より低い場合には充電動作を開始する。まず、ロボット本体10はその場で一回転する。例えば左側に旋回し始め、センサ12がオンなっているかどうかを判断し(S113)、オンなっていれば信号発生装置170は左側にあるものとし、ステップモータ64を駆動する(S114)。これにより車輪38が回転駆動して左側に旋回する。また、センサ14がオンなっているかどうかを判断し(S115)、オンなっていれば信号発生装置170は右側にあるものとし、ステップモータ66を駆動する(S116)。これにより車輪36が回転駆動して右側に旋回する。なお、このセンサ12,14はそれぞれ2個の素子を内蔵し、一方の素子は例えば通常の光に応答してガイド用いられ、他方の素子は例えば信号発生装置370からの赤外線にのみ反応して充電エリア374をサーチするのに用いられるものとする。 FIG. 56 is a flowchart showing the operation at the time of automatic charging. The CPU core 40 takes in the voltage value of the power supply unit 16, determines whether the voltage value is higher than a predetermined reference voltage (S111), and if it is higher, continues the normal operation (S112). When the voltage of the power supply unit 16 is lower than the predetermined reference voltage VL, the charging operation is started. First, the robot body 10 makes one rotation on the spot. For example, the vehicle starts to turn to the left and determines whether the sensor 12 is on (S113). If the sensor 12 is on, the signal generator 170 is assumed to be on the left and the step motor 64 is driven (S114). As a result, the wheel 38 is driven to rotate and turns to the left. Further, it is determined whether or not the sensor 14 is on (S115). If it is on, the signal generator 170 is assumed to be on the right side, and the step motor 66 is driven (S116). As a result, the wheel 36 is driven to rotate and turns rightward. Each of the sensors 12 and 14 has two built-in elements. One of the elements is used as a guide in response to, for example, ordinary light, and the other is in response to only infrared rays from the signal generator 370, for example. It shall be used to search the charging area 374.

 次に、図48のスイッチ320,322を閉成し、仮にロボット本体10が充電エリア374に到達すると、励磁コイル68は充電コイル380によって発生する磁界を受けて誘起電圧を発生する。この誘起電圧はインバータ324,326及びオア回路328を介してCPUコア40に取り込まれ、そこで交流磁界が検出されたことが検出される(S117)。このようにして交流磁界が検出されると、ロボット本体10は充電エリア174の上にいることになるので、ステップモータ64,66の駆動を停止する(S118)。励磁コイル68は充電コイル380によって発生する磁界を受けて誘起電圧を発生し、その誘起電圧はダイオード312,318,316,306により整流されて電源部16に導かれ、電源部16には充電電流が供給される。そして、CPUコア40は電源部16の電圧を取り込んでそれが基準値VH より高いかどうかを判断し(S119)、高くなると再び通常の動作に移る(S112)。 Next, when the switches 320 and 322 in FIG. 48 are closed and the robot body 10 reaches the charging area 374, the exciting coil 68 receives the magnetic field generated by the charging coil 380 and generates an induced voltage. This induced voltage is taken into the CPU core 40 via the inverters 324, 326 and the OR circuit 328, where it is detected that an AC magnetic field has been detected (S117). When the AC magnetic field is detected in this manner, the robot main body 10 is on the charging area 174, and the driving of the step motors 64 and 66 is stopped (S118). The exciting coil 68 receives the magnetic field generated by the charging coil 380 and generates an induced voltage. The induced voltage is rectified by the diodes 312, 318, 316 and 306 and guided to the power supply unit 16. Is supplied. Then, the CPU core 40 takes in the voltage of the power supply section 16 and determines whether or not the voltage is higher than the reference value VH (S119). When it becomes higher, the operation returns to the normal operation (S112).

 なお、充電スタンドの信号発生装置370は超音波、磁気等を発生するものでもよい。その場合にはロボット本体側にはそれを検出するセンサを装備する必要がある。また、エネルギー供給装置372から発生する磁気、光、熱等を検出して移動するようにしてもよい。その場合には信号発生装置370は不要になる。
 更に、エネルギー供給装置372はロボット本体10が充電エリア374に到達してから作動させるようにしてもよく、その場合には省エネルギー化が図られる。
Note that the signal generator 370 of the charging station may generate ultrasonic waves, magnetism, or the like. In that case, it is necessary to equip the robot main body with a sensor for detecting it. Further, it may be moved by detecting magnetism, light, heat or the like generated from the energy supply device 372. In that case, the signal generator 370 becomes unnecessary.
Further, the energy supply device 372 may be operated after the robot body 10 reaches the charging area 374, in which case energy saving is achieved.

 図57〜図60は本発明の他の実施例に係るマイクロロボットを示す図であり、図57は前方から見た図、図58は後方から見た図、図59は図58の59−59断面図、図60はアームの機能を説明する図である。この実施例のマイクロロボットは、管内を流れる液体中でフィンを回転することにより推進すると共に、充電時には液体の流れを利用して発電しそれにより充電するようにしたものである。ロボット本体10の前部には4本のアーム400が取り付けられており、後部にはフィン402が取り付けられその外周部には外歯404が設けられている。また、フィン402はカバー部406により覆われている。フィン402はピニオン408を介してステップモータ66に連結されている。アーム400はその一方の端部がプランジャ410により駆動されるように構成されており、プランジャ410が引かれるとアーム400が拡がり、アーム400の端部が管の内壁に押し当てられるとロボット本体10は液中に停留する。 57 to 60 are views showing a micro robot according to another embodiment of the present invention. FIG. 57 is a view seen from the front, FIG. 58 is a view seen from the back, and FIG. 59 is a view 59-59 of FIG. FIG. 60 is a sectional view illustrating the function of the arm. The microrobot according to this embodiment is designed to be propelled by rotating fins in a liquid flowing in a tube, and to generate power by using the flow of the liquid during charging, thereby performing charging. Four arms 400 are attached to the front of the robot body 10, fins 402 are attached to the rear, and external teeth 404 are provided on the outer periphery. The fin 402 is covered by a cover 406. The fin 402 is connected to the step motor 66 via a pinion 408. The arm 400 is configured so that one end thereof is driven by a plunger 410. When the plunger 410 is pulled, the arm 400 expands, and when the end of the arm 400 is pressed against the inner wall of the pipe, the robot body 10 is moved. Stays in the liquid.

 この実施例の回路22の構成は図47に示されているものと基本的には同一であり、図47のステップモータ64をプランジャ410に置き換えればよい。通常の動作状態においては、ステップモータ66よりフィン402が回転駆動されロボット本体10は液中を前進する。そして、電源部16の電圧が所定の基準値VL より低くなると、ステップモータ66の駆動を停止し、プランジャ410を引いてアーム400を拡げる。これによりロボット本体10が液体中にて停止することになる。その停留状態にて管内に液が流れていると、フィン402が回転しその結果ステップモータ66のロータ70が回転し、励磁コイル68に誘起電圧が発生し、その誘起電圧は上述の実施例の場合と同様に整流されて電源部16に導かれ、電源部16に充電電流が供給される。このようにして充電され所定の基準電圧VH 以上になると、プランジャ410を復帰させてアーム400を閉じてロボット本体10の停留状態を解き、ステップモータ66を駆動することにより再び前進を開始する。 The structure of the circuit 22 of this embodiment is basically the same as that shown in FIG. 47, and the step motor 64 in FIG. In a normal operation state, the fin 402 is rotationally driven by the step motor 66, and the robot body 10 advances in the liquid. When the voltage of the power supply 16 becomes lower than the predetermined reference value VL, the driving of the step motor 66 is stopped, and the arm 400 is extended by pulling the plunger 410. As a result, the robot body 10 stops in the liquid. When the liquid flows in the pipe in the stopped state, the fins 402 rotate, and as a result, the rotor 70 of the step motor 66 rotates, and an induced voltage is generated in the exciting coil 68. As in the case described above, the current is rectified and guided to the power supply unit 16, and a charging current is supplied to the power supply unit 16. When the battery is charged in this manner and becomes equal to or higher than the predetermined reference voltage VH, the plunger 410 is returned, the arm 400 is closed, the stationary state of the robot body 10 is released, and the stepping motor 66 is driven to start forward again.

 図61は光起電力素子により充電する場合の制御部の構成を示すブロック図である。光起電力素子として例えばソーラーセル412を有し、このソーラーセル412の出力は電圧調整器56のリミッタ302(図47参照)を介して電源部16に供給されると共に、デコーダ416を介してCPUコア40に供給される。
 図62は図61の実施例の動作を示すフローチャートである。この実施例においては通常の作業時もソーラーセル412により充電をしている。ところが、電源部16の電圧が所定の基準電圧VL より低くなると(S121)、ステップモータ64,66を駆動し(S122)、その状態をこれらのモータの回転が検出できなくなるまで継続する(S123),(S124)。つまり、ステップモータ64,66をロボット本体10が壁等に衝突するまで駆動することによりロボット本体10を隅の方に退避させ、その状態で例えば100秒程度の間充電する(S125)。そして、電源部16の電圧が所定の基準電圧VL より高くなると(S121)、再び通常の作業時に戻る(S122)。なお、この実施例においては発光側の発光素子を制御することにより、発光素子からエネルギーを供給するだけでなく、制御信号を発光エネルギーに重畳させることにより制御信号を供給することもできる。ロボット本体10側ではソーラーセル212の出力をデコーダ416により解析してCPUコア40に取り込む。
FIG. 61 is a block diagram illustrating a configuration of a control unit when charging is performed by a photovoltaic element. For example, a solar cell 412 is provided as a photovoltaic element. The output of the solar cell 412 is supplied to the power supply unit 16 via the limiter 302 (see FIG. 47) of the voltage regulator 56, and the CPU is supplied via the decoder 416. It is supplied to the core 40.
FIG. 62 is a flowchart showing the operation of the embodiment in FIG. In this embodiment, the battery is charged by the solar cell 412 even during normal work. However, when the voltage of the power supply 16 becomes lower than the predetermined reference voltage VL (S121), the step motors 64 and 66 are driven (S122), and the state is continued until the rotation of these motors cannot be detected (S123). , (S124). That is, by driving the step motors 64 and 66 until the robot main body 10 collides with a wall or the like, the robot main body 10 is retreated to a corner, and charged in this state for, for example, about 100 seconds (S125). Then, when the voltage of the power supply unit 16 becomes higher than the predetermined reference voltage VL (S121), the operation returns to the normal operation (S122). In this embodiment, by controlling the light emitting element on the light emitting side, not only energy can be supplied from the light emitting element, but also a control signal can be supplied by superimposing a control signal on the light emitting energy. On the robot body 10 side, the output of the solar cell 212 is analyzed by the decoder 416 and is taken into the CPU core 40.

 ところで、図61の実施例においてはソーラーセル412による例について説明したが、これを熱発電素子に置き換えてもよい。熱発電素子は温度差により発電するので、エネルー供給側においては吸熱及び発熱を交互に繰り返せば(充電スタンドにて吸発熱素子を駆動する)、熱発電素子は継続的に発電できる。但し、その場合には、熱発電素子の出力は交互に正、負を繰り返すので、充電回路214には整流回路が必要となる。この場合だけでなく、電磁誘導により充電する場合において、励磁コイル68によらず、充電用のコイルをソーラーセル212の代わりに設けてそれによって電源部16を充電する場合にも整流回路が必要になる。 By the way, although the example of the solar cell 412 has been described in the embodiment of FIG. 61, this may be replaced with a thermoelectric generator. Since the thermoelectric generator generates power based on the temperature difference, if the heat absorption and heat generation are alternately repeated on the energy supply side (by driving the heat absorption and generation elements at the charging station), the thermoelectric generator can continuously generate power. However, in this case, the output of the thermoelectric generator alternates between positive and negative alternately, so that the charging circuit 214 requires a rectifier circuit. Not only in this case, but also in the case of charging by electromagnetic induction, a rectifying circuit is required in the case where a charging coil is provided instead of the solar cell 212 and the power supply unit 16 is charged by using the charging coil instead of the excitation coil 68. Become.

 図63は充電、障害回避、作業及び帰投を組み合わせた制御をする場合の動作を示すフローチャートである。CPUコア40は電源部16の電圧を取り込んでその値が所定の基準電圧VL より高いかどうかを判断する(S131)。電源部16の電圧が所定の基準電圧VL よりも低ければ充電動作に移る(S132)。この充電動作は上述の各実施例における動作と同一である。電源部16の電圧が所定の基準電圧VL よりも高ければ、次に障害物があるかどうかを判断する(S133)。障害物の有無の検出は、例えば障害物検出用のセンサを取り付けてそれにより検出したり、ステップモータが回転していない状態を検出することにより行う。後者の場合の検出は次のようにして行なう。回転状態にあるときにはステップモータの励磁コイルに駆動パルスを供給した後に、誘起電圧が大となり、回転していない状態においては誘起電圧が小となるので、誘起電圧の大きさを検出することによりその判断がなされる。 FIG. 63 is a flowchart showing the operation in the case of performing a control combining charging, obstacle avoidance, work, and return throw. The CPU core 40 takes in the voltage of the power supply unit 16 and determines whether the value is higher than a predetermined reference voltage VL (S131). If the voltage of the power supply unit 16 is lower than the predetermined reference voltage VL, the operation proceeds to the charging operation (S132). This charging operation is the same as the operation in each embodiment described above. If the voltage of the power supply unit 16 is higher than the predetermined reference voltage VL, it is determined whether there is an obstacle next (S133). The presence or absence of an obstacle is detected, for example, by attaching and detecting an obstacle detection sensor, or by detecting a state in which the step motor is not rotating. The detection in the latter case is performed as follows. When a driving pulse is supplied to the excitation coil of the step motor when in the rotating state, the induced voltage becomes large, and when the motor is not rotating, the induced voltage becomes small. Judgment is made.

 障害物があると判断されたときには(S133)、回避動作をする(S134)。回避動作としては、停止、後退等の制御処理を行うことによりなされる。障害物がないと判断されると、所望の作業(前進等)を行う(S134)。次に、帰投指令あるかどうかを判断し(S135)、帰投指令がなければ上述の処理を繰り返し、帰投指令があった場合には帰投する(S135)。この実施例においては帰投指令が外部からあるまでの作業を続けているが、作業が終わったら自動的に帰投するようにしてもよい。帰投の方法は充電スタンドへの移動と同様になされる。 と き に は When it is determined that there is an obstacle (S133), an avoidance operation is performed (S134). The avoidance operation is performed by performing control processing such as stopping and retreating. If it is determined that there is no obstacle, a desired operation (such as forward movement) is performed (S134). Next, it is determined whether or not there is a return-to-throw instruction (S135). If there is no return-to-throw instruction, the above-described processing is repeated, and if there is a return-to-throw instruction, return is made (S135). In this embodiment, the operation is continued until the return instruction is issued from the outside. However, the return operation may be automatically performed after the operation is completed. The method of returning home is the same as that of moving to the charging station.

本発明の一実施例のマイクロロボットの側面図である。1 is a side view of a micro robot according to an embodiment of the present invention. 図1の上面図である。FIG. 2 is a top view of FIG. 1. 図1の底面図である。FIG. 2 is a bottom view of FIG. 1. 傾斜した走行グランドをロボット本体が登る場合の説明図である。It is explanatory drawing in case a robot main body climbs the inclined traveling ground. 本発明の他の実施例のマイクロロボットの側面図である。FIG. 7 is a side view of a micro robot according to another embodiment of the present invention. 図5の底面図である。FIG. 6 is a bottom view of FIG. 5. 上記マイクロロボットの車輪の側面拡大図である。It is a side enlarged view of the wheel of the said micro robot. 回路部の詳細を示したブロック図である。FIG. 3 is a block diagram illustrating details of a circuit unit. センサの回路図である。It is a circuit diagram of a sensor. 駆動部の平面図である。It is a top view of a drive part. 図10の駆動部の展開図である。It is a development view of the drive part of FIG. 図1又は図5の実施例のロボットの基本動作例を示すタイミングチャートである。6 is a timing chart showing a basic operation example of the robot of the embodiment shown in FIG. 1 or 5. 図13は図5の実施例のロボットの駆動開始時の基本動作を示すタイミングチャートである。FIG. 13 is a timing chart showing a basic operation of the embodiment of FIG. 5 at the start of driving of the robot. 図5の実施例のロボットの駆動開始時の動作を示すタイミングチャートである。6 is a timing chart showing the operation of the embodiment of FIG. 5 at the start of driving of the robot. 図5の実施例のロボットの駆動パルスの波形図である。FIG. 6 is a waveform diagram of a driving pulse of the robot of the embodiment of FIG. 5. 障害物を回避する場合の処理(その1)を示すフローチャートである。It is a flowchart which shows the process (the 1) in the case of avoiding an obstacle. その回避動作の説明図である。It is an explanatory view of the avoidance operation. 障害物を回避する場合の処理(その2)を示すフローチャートである。11 is a flowchart illustrating a process (part 2) for avoiding an obstacle. その回避動作の説明図である。It is an explanatory view of the avoidance operation. ステップモータの回転の有無を検出する方法を示したタイミングチャートである。5 is a timing chart showing a method for detecting whether or not a step motor is rotating. 本発明の他の実施例に係るマイクロロボットの正面、側面及び背面をそれぞれ示した図である。FIG. 7 is a diagram illustrating a front, side, and back of a microrobot according to another embodiment of the present invention. 本発明の他の実施例に係るマイクロロボットの正面、側面及び背面をそれぞれ示した図である。FIG. 7 is a diagram illustrating a front, side, and back of a microrobot according to another embodiment of the present invention. 本発明の他の実施例に係るマイクロロボットの正面、側面及び背面をそれぞれ示した図である。FIG. 7 is a diagram illustrating a front, side, and back of a microrobot according to another embodiment of the present invention. 図21〜図23の実施例のモータ駆動回路の周辺の回路を示したブロック図である。FIG. 24 is a block diagram showing peripheral circuits of the motor drive circuit of the embodiment shown in FIGS. 本発明の他の実施例のマイクロロボットの上面図である。FIG. 7 is a top view of a micro robot according to another embodiment of the present invention. 図25の実施例の回路部の詳細を示したブロック図である。FIG. 26 is a block diagram showing details of a circuit unit of the embodiment in FIG. 25. 図26の回路部の制御動作を示すフローチャートである。27 is a flowchart illustrating a control operation of the circuit unit in FIG. 26. 図25及び図26において作業制御用センサを装備しなかった場合の動作を示すフローチャートである。FIG. 27 is a flowchart showing an operation when the work control sensor is not provided in FIGS. 25 and 26. 回路部の他の実施例の詳細を示すブロック図である。It is a block diagram showing details of other examples of a circuit part. 本発明の他の実施例のロボット本体の上面図である。It is a top view of the robot main body of other Example of this invention. 図29の回路部の制御動作を示すフローチャートである。30 is a flowchart illustrating a control operation of the circuit unit in FIG. 29. 本発明のマイクロロボットを内視鏡に適用した例を示す断面図である。It is sectional drawing which shows the example which applied the micro robot of this invention to an endoscope. 本発明の他の実施例に係るマイクロロボットの底面図である。FIG. 9 is a bottom view of a micro robot according to another embodiment of the present invention. 図33のマイクロロボットの側面図である。FIG. 34 is a side view of the micro robot of FIG. 33. 本発明の他の実施例に係るマイクロロボットの側面図である。FIG. 7 is a side view of a micro robot according to another embodiment of the present invention. 図35のマイクロロボットの底面図である。FIG. 36 is a bottom view of the microrobot of FIG. 35. 図37は図35及び図36のマイクロロボットの回路部の詳細を示したブロック図である。FIG. 37 is a block diagram showing details of a circuit section of the micro robot shown in FIGS. 35 and 36. 図35〜図37のマクロロボットの制御動作を示したフローチャートである。38 is a flowchart showing a control operation of the macro robot of FIGS. 35 to 37. 図35のマイクロロボットがハンドを上げたときの状態を示す図である。FIG. 36 is a diagram illustrating a state where the micro robot in FIG. 35 raises a hand. 図35のマイクロロボットがハンドを開いたときの状態を示す図である。FIG. 36 is a diagram illustrating a state where the microrobot of FIG. 35 opens the hand. 本発明の他の実施例に係るマイクロロボットの概念図である。FIG. 9 is a conceptual diagram of a micro robot according to another embodiment of the present invention. 図41の側面図である。FIG. 42 is a side view of FIG. 41. 作業用モータの詳細を示した図である。It is a figure showing the details of the work motor. 作業モータの動作原理を示した図である。It is a figure showing the operation principle of a work motor. 作業モータの動作原理を示した図である。It is a figure showing the operation principle of a work motor. 作業モータの動作原理を示した図である。It is a figure showing the operation principle of a work motor. 回路部に電磁誘導による充電機構を付加した回路部の詳細を示したブロック図である。It is the block diagram which showed the detail of the circuit section which added the charging mechanism by electromagnetic induction to the circuit section. 図47の実施例のモータ駆動回路の詳細を示すブロック図である。FIG. 48 is a block diagram showing details of a motor drive circuit of the embodiment in FIG. 47. 電源部を構成している電気二重層コンデンサの放電特性図である。FIG. 4 is a discharge characteristic diagram of an electric double layer capacitor constituting a power supply unit. 電圧調整器の詳細を示す回路説明図である。FIG. 3 is a circuit diagram illustrating details of a voltage regulator. 昇圧手段の動作説明図である。FIG. 5 is an explanatory diagram of the operation of the booster. 昇圧手段の動作説明図である。FIG. 5 is an explanatory diagram of the operation of the booster. 昇圧手段の動作説明図である。FIG. 5 is an explanatory diagram of the operation of the booster. 充電スタンドの斜視図である。It is a perspective view of a charging stand. エネルギー供給装置の構成を示すブロック図である。FIG. 2 is a block diagram illustrating a configuration of an energy supply device. 自動充電時の動作を示すフローチャートである。6 is a flowchart showing an operation at the time of automatic charging. 本発明の他の実施例に係るマイクロロボットの正面図である。FIG. 7 is a front view of a micro robot according to another embodiment of the present invention. 図57のマイクロロボットの背面図である。FIG. 58 is a rear view of the microrobot of FIG. 57. 図58の59−59断面図である。FIG. 59 is a cross-sectional view taken along line 59-59 of FIG. 58. 図57のアームの機能を説明する図である。FIG. 58 is a diagram illustrating the function of the arm in FIG. 57. 光起電力素子により充電する場合の制御部の構成を示すブロック図である。FIG. 4 is a block diagram illustrating a configuration of a control unit when charging is performed by a photovoltaic element. 図61の実施例の動作を示すフローチャートである。FIG. 62 is a flowchart showing the operation of the embodiment in FIG. 61. 充電、障害回避、作業及び帰投を組み合わせた制御をする場合の動作を示すフローチャートである。It is a flowchart which shows the operation | movement at the time of performing control which combines charging, obstacle avoidance, operation | work, and return throw.

Claims (2)

 検出領域が一部重複する少なくとも2個のセンサと、
 互いに独立して駆動され、移動方向に対し直角方向に離れた駆動点を有する少なくとも1対の駆動部と、
 前記センサの出力に基づいて前記駆動部を制御する制御部と、
 充電可能であり、前記センサ、前記駆動部及び前記制御部に電源電圧を供給する電源部とを有し、
 前記制御部及び前記電源部が前記駆動部の間に配置され、前記1対の駆動部によって走行グランドに対して駆動される2つの駆動点と、走行グランドに対してすべり摩擦接触する摺動部の3点により支持されることを特徴とするマイクロロボット。
At least two sensors whose detection areas partially overlap,
At least one pair of driving units driven independently of each other and having driving points separated in a direction perpendicular to the moving direction;
A control unit that controls the driving unit based on an output of the sensor;
A power supply unit that is rechargeable and supplies a power supply voltage to the sensor, the driving unit, and the control unit,
The control unit and the power supply unit are disposed between the driving units, and two driving points driven by the pair of driving units with respect to a traveling ground, and a sliding unit that is in sliding frictional contact with the traveling ground. A micro robot characterized by being supported by the following three points.
 框体より突出し可撓性を有し、かつ電源部と導通している突起部を有し、該突起部に通電することにより前記電源部を充電することを特徴とする請求項1記載のマイクロロボット。
2. The micro device according to claim 1, further comprising: a protrusion protruding from the frame body and having flexibility and being electrically connected to the power supply unit, wherein the power supply unit is charged by supplying electricity to the protrusion. robot.
JP2003294922A 1991-11-05 2003-08-19 Micro robot Expired - Lifetime JP3674619B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2003294922A JP3674619B2 (en) 1991-11-05 2003-08-19 Micro robot

Applications Claiming Priority (5)

Application Number Priority Date Filing Date Title
JP28876491 1991-11-05
JP7169692 1992-03-27
JP7169792 1992-03-27
JP7169892 1992-03-27
JP2003294922A JP3674619B2 (en) 1991-11-05 2003-08-19 Micro robot

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2002222997A Division JP3480465B2 (en) 1991-11-05 2002-07-31 Micro robot

Publications (2)

Publication Number Publication Date
JP2004001230A true JP2004001230A (en) 2004-01-08
JP3674619B2 JP3674619B2 (en) 2005-07-20

Family

ID=30449625

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2003294922A Expired - Lifetime JP3674619B2 (en) 1991-11-05 2003-08-19 Micro robot

Country Status (1)

Country Link
JP (1) JP3674619B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101246658B1 (en) 2011-03-15 2013-04-02 한국과학기술원 Inspection robot with solar cell and method for controlling inspection robot
KR101291404B1 (en) 2012-09-18 2013-07-30 한국과학기술원 Inspection robot with solar cell

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6197711A (en) * 1984-10-18 1986-05-16 Casio Comput Co Ltd Infrared-ray tracking robot system
JPS6248474A (en) * 1985-08-28 1987-03-03 フアナツク株式会社 Self-advancing type mobile robot
JPS6254685A (en) * 1985-08-29 1987-03-10 フアナツク株式会社 Method of controlling drive of travelling type arm robot
JPS62105207A (en) * 1985-10-31 1987-05-15 Sanyo Electric Co Ltd Guiding device for mobile robot
JPS62298813A (en) * 1986-06-18 1987-12-25 Motoda Electronics Co Ltd Movable body controller
JP3480465B2 (en) * 1991-11-05 2003-12-22 セイコーエプソン株式会社 Micro robot

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6197711A (en) * 1984-10-18 1986-05-16 Casio Comput Co Ltd Infrared-ray tracking robot system
JPS6248474A (en) * 1985-08-28 1987-03-03 フアナツク株式会社 Self-advancing type mobile robot
JPS6254685A (en) * 1985-08-29 1987-03-10 フアナツク株式会社 Method of controlling drive of travelling type arm robot
JPS62105207A (en) * 1985-10-31 1987-05-15 Sanyo Electric Co Ltd Guiding device for mobile robot
JPS62298813A (en) * 1986-06-18 1987-12-25 Motoda Electronics Co Ltd Movable body controller
JP3480465B2 (en) * 1991-11-05 2003-12-22 セイコーエプソン株式会社 Micro robot

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101246658B1 (en) 2011-03-15 2013-04-02 한국과학기술원 Inspection robot with solar cell and method for controlling inspection robot
KR101291404B1 (en) 2012-09-18 2013-07-30 한국과학기술원 Inspection robot with solar cell

Also Published As

Publication number Publication date
JP3674619B2 (en) 2005-07-20

Similar Documents

Publication Publication Date Title
US5610488A (en) Micro robot
JP3131871B2 (en) Micro robot
EP1430826B1 (en) Automatic charging device for an automatically travelling cleaner and method of automatically charging an automatically travelling cleaner
JP2846835B2 (en) Charge induction device and method for robot vacuum cleaner
US5841259A (en) Vacuum cleaner and control method thereof
EP0623861B1 (en) Micro-robot and its storage case
US20050234595A1 (en) Self-propelled cleaner and method of controlling the same
US11320835B2 (en) Magnetic navigation systems for autonomous mobile robots
WO2013010475A1 (en) Self-driving apparatus, guidance system, and moving method therefor
US20060069507A1 (en) Mobile device and method for controlling the same
JP3191717B2 (en) Micro robot
JP3674619B2 (en) Micro robot
JP3028607B2 (en) Micro robot
JP3554234B2 (en) Micro robot
JP3480465B2 (en) Micro robot
JPH06170770A (en) Microrobot
JP2933052B2 (en) Micro robot
JP2007156884A (en) Self-propelled cleaner system
JP3277919B2 (en) Micro robot
Efaz et al. Design of an indicative featured and speed controlled obstacle avoiding robot
CN219636046U (en) Intelligent garbage can
Shah et al. Unsupervised Maneuvering Robot for Scouring Application
CN117879183A (en) Charging method and device for robot, robot and medium
JPH0451422Y2 (en)
Eskenas Design of a single-legged robot

Legal Events

Date Code Title Description
A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20041005

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20041117

A911 Transfer of reconsideration by examiner before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A911

Effective date: 20041122

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20050418

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090513

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100513

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110513

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120513

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130513

Year of fee payment: 8

EXPY Cancellation because of completion of term
FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130513

Year of fee payment: 8