WO1992002398A1 - Robot de secours en cas de catastrophe et unite associee de commande des manoeuvres - Google Patents
Robot de secours en cas de catastrophe et unite associee de commande des manoeuvres Download PDFInfo
- Publication number
- WO1992002398A1 WO1992002398A1 PCT/JP1991/001061 JP9101061W WO9202398A1 WO 1992002398 A1 WO1992002398 A1 WO 1992002398A1 JP 9101061 W JP9101061 W JP 9101061W WO 9202398 A1 WO9202398 A1 WO 9202398A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- robot
- crawler
- turning
- main body
- load
- Prior art date
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D55/00—Endless track vehicles
- B62D55/06—Endless track vehicles with tracks without ground wheels
- B62D55/065—Multi-track vehicles, i.e. more than two tracks
Definitions
- the present invention prevents a fall accident from a cliff or the like when transporting rescue equipment, medical supplies, foodstuffs, and other rescue materials outdoors in the event of a wide-area disaster such as local farming, rainfall or landslides.
- the present invention relates to a disaster relief robot and its control device that can ensure the safety of the disaster. Background technology
- a remote-controlled traveling robot that has four rollers for traveling and is used for treating hazardous materials on nuclear facilities and flat ground (for example, — See 270-3).
- this is a system in which independent crawlers 2 are provided at the four corners of the mouth body 1, and each crawler 2 has a rotating shaft 2a for the robot body. And can be turned independently of each other. For this reason, in addition to traveling normally with the crawlers 2 placed in a horizontal position, it is also possible to raise each of the crawlers 2 to move freely in a narrow space ⁇ , or to incline each of the crawlers 2 to get over a step. it can.
- the rear crawler 2R is tilted in the collapsed area
- the stereo camera 3 mounted on the robot body 1 is remotely controlled in a cautious posture such that it faces the lower front. It is advisable to drive cautiously because there is nothing obstructing the view of Camera 3 indoors.
- weeds and other obstacles often hinder the field of view outside the affected area, as shown in Fig. 19 (b).
- the front crawler 2F sometimes keeps moving forward even if it misses.
- the remote control of the robot is performed by turning the four knobs for manipulating the opening and closing positions arranged on the flat surface of the pilot.
- the turning angles of these knobs represent the turning angles of the four links.
- the present invention focuses on the above-mentioned conventional problems, and has no problem at all when traveling on uneven terrain after a wide area disaster, even on a depression or a stepped portion, and also has an impact against a fall or the like.
- Disaster relief robots that do not damage the power system, and intuitively grasp the attitude of each crawler, enabling remote control with good responsiveness, and falling accidents irrespective of the operator's monitoring ability etc.
- the aim is to provide a disaster relief robot operation control device that can avoid accidents beforehand and ensure safety without imposing great strain on the operator. Disclosure of the invention
- a pair of left and right crawlers are provided on the front side and the rear side of the robot main body, and each of the crawlers is independently driven and controlled.
- the track frame of the crawler is pivotally attached to the robot body via the turning axis, and the turning axes of the front and rear crawlers — —
- the distance between the maximum turning circles is set so as not to interfere with each other, and the center of gravity of the robot body is set at an intermediate position between the turning axes of the front and rear crawlers.
- a torque limiter is placed in the track power transmission system of the track frame of the crawler so that torque transmission can be cut off when the reaction force from the track frame is greater than the set value.
- a sensor that detects the angle of the turning surface may be attached to the turning power transmission system from the torque limiter to the track frame.
- the operation control device of the disaster relief robot is provided with a four-turn angle detector and a knob for manipulating the track frame of each crawler on the robot controller, and the four knobs are provided.
- the turning motor of the track frame of each crawler uses the turning angle signals from the four turning angle detectors as the turning angle target value signal.
- the control is performed by a control surface which calculates and outputs a difference from a feedback signal from a turning angle detector attached to each turning motor.
- Bilateral control (Bi lateral Control) may be performed by a control circuit that calculates and outputs the difference from the signal.
- the operation control device of the disaster relief robot controls the track frame of each crawler via the rotation axis so that the front crawler and the rear crawler of the robot main body do not interfere with each other.
- Tilt detection means for detecting the forward tilt angle of the robot body
- load detection means for detecting the load applied to the front crawler for each of the left and right crawlers.
- the weather inclination detecting means detects that the robot body has gone ahead by a predetermined angle or more, or when the load on at least one of the left and right crawlers falls below the predetermined value by the load detecting means
- drive control means for controlling the drive of the turning axis so that the robot main body does not fall down and for controlling the drive of the sprocket is provided.
- the track frame of each crawler has a large degree of freedom of a turning surface of 360 ', and can take any turning posture. Therefore, when traveling in a depressed area where cliffs and the like exist, the robot can easily take a posture in which the robot body does not fall down by setting the front crawler to a turning posture extended forward. Even if only the front crawler derails to a useful surface such as a cliff, it does not fall down easily because the center of gravity is in front of the slope.
- the robot When the detected value of the inclination detecting means is equal to or larger than a predetermined wheel, or when the detected value of the load detecting means is equal to or less than a predetermined value, it is automatically and automatically determined that the robot may fall down. Accurately determined. That is, it is possible to automatically and accurately determine whether there is a risk of falling without depending on the monitoring ability of the operator.
- the turning axis and the sub-block are driven and controlled, so that the turning posture is automatically set so that the mouth-box does not fall down, and travel control is performed.
- Fig. 1 is a configuration diagram showing the drive mechanism of the disaster relief robot according to the present invention
- Fig. 2 is a side view of the robot
- Fig. 3 is a plan view of the robot
- Fig. 4 is a diagram of the robot.
- Front view Fig. 5 is a block diagram of the operation control system of the robot
- Fig. 6 is an explanatory diagram of the operation of the robot in a collapsed area
- Fig. 7 is an explanatory diagram of the overbank operation of the robot.
- FIG. 8 is an explanatory diagram of typical postures that the robot can take.
- FIG. 9 is a simple perspective view of a pilot controller for explaining a first embodiment of the pilot control device according to the present invention
- FIG. 10 is a simple external view of a robot main body
- FIG. Fig. 12 is an interconnection diagram of the control unit, the control unit, and the robot body
- Fig. 12 is a block diagram of the control system based on Fig. 11
- Fig. 13 is the control unit.
- FIG. 14 is a flow chart in the case of operation with a microcomputer
- FIG. 14 is a simple perspective view of a steering device for explaining a second embodiment of the steering control device according to the present invention
- FIG. FIG. 2 is a block diagram of a remote control system based on FIG.
- FIG. 16 is a flow chart for sharpening a third embodiment of the steering control device according to the present invention
- FIG. 17 is an explanatory diagram of the operation of the robot corresponding to the processing of FIG.
- Fig. 18 is a perspective view of a conventional traveling robot
- Fig. 19 is an explanatory diagram of the operation in a collapsed area by the conventional traveling robot
- Fig. 20 is a diagram of the overbank operation by the conventional traveling robot.
- FIG. 1 is a configuration diagram showing a drive mechanism of a disaster relief robot according to the present invention
- FIGS. 2 to 4 are external views of the robot.
- This robot is equipped with a crawler 12 F (R) which is turned at each of the four corners of the robot body 10 by an independent driving period.
- the track frame 16 of each crawler 12 F (R) has a pivot axis 14 and is attached to the robot main body 10 so as to be able to turn 360 degrees around the pivot axis.
- the front and rear crawlers 12 F and 12 R located on one side of the robot body 10 separate the ridges of each turning axis 14 so that the maximum turning tracks CF and CR do not overlap. And attached to the robot body 10.
- the distance L between the turning axes of the front and rear crawlers 12 F and 12 R is set to be larger than the sum of the radii of the maximum turning tracks C F and CR. Then, the center of gravity G of the robot main body 10 is set so as to pass through the middle of these maximum turning trajectories CF and CR, and the grounding positions of the front and rear crawlers 12 F and 12 R are always outside the true center of gravity G. It is made to become. For this reason, the front and rear crawlers 12 F and 12 R are arranged at positions near the front and rear ends of the robot body 10, and due to their turning operations, the front and rear crawler 12 F and 12 R are turned. A maximum extension state in which the tips extend forward and backward of the robot body 10 respectively, and a minimum contraction state in which the tips of the turning surfaces are directed toward the center of gravity can be adopted.
- Crawler 12 F (R) is composed of a track frame 16, a driving sprocket 20 disposed at one end thereof, and an idler 21 allocated to the other side. It is composed of a bearing wheel 22 arranged in the middle of the two, and a rubber track 18 wound around these.
- the turning shaft 14 of the bracket 20 penetrates into the robot main body 10 and is driven by a traveling motor 26 via a speed reducer 28 and a tune 30. Then, the rubber track 18 is driven so as to roll on the outer periphery of the track frame 16, and the robot runs.
- the turning shaft 14 is a cylindrical shaft including the running surface turning shaft 24, and penetrates from the side end of the robot body 10 via a bearing to the inside.
- a gear 32 is freely rotatably mounted, and the gear 32 is integrated with the turning shaft 14 via a torque limiter 34.
- a rotating motor 36 and a speed reducer 38 for applying a face-to-face driving force to the gear 32 are installed in the robot body 10, and a drive gear 40 attached to an output shaft thereof and the gear 3 and 2 are connected via an intermediate gear 42.
- the surface rolling power of the turning motor 36 is transmitted to the turning shaft 14 via the speed reducer 38, the driving gear 40, the intermediate gear 42, the gear 32, and the torque limiter 34.
- the track frame 16 of the crawler 12 F (R) is to be turned.
- the torque limiter 34 interrupts the power transmission path when a forced turning force is applied to the crawler 12 F (R) due to a fall or the like. In the event of occurrence, the joint with the gear 3 2 mounted on the turning shaft 14 is released.
- a rotary encoder 44 is attached to the turning shaft 14 so as to detect the turning position of the turning shaft 14 and, consequently, the turning angle of the track frame 16. This is provided particularly on the turning surface transmission path from the torque limiter 34 to the track frame 16.
- FIG. 5 is a block diagram of the steering control system of the ⁇ bot.
- This robot is remotely controlled by a control signal of a remote control transmitter 46.
- the remote control receiver 48 and the control device 50 are mounted on the ⁇ -bot main body 10.
- the control device 50 receives the steering signal and outputs a fuel control signal to the engine control device 52 to control the engine 54.
- the engine 54 drives a generator 55 which is a power source of the traveling motor 26 and the turning surface motor 36.
- the controller 50 outputs a control signal to the motor driving power supply units 56, 58 for adjusting the rotational power of the motors 26, 36, while the control unit 50 outputs a speed signal attached to each motor 26, 36.
- the control signals are fed back to control signals inputted from the control signals 60 and 62, and the traveling speed and the turning angle are set based on the control signals.
- the control device 50 directly captures the output signal of the encoder 44 that detects the angle of rotation of the turning shaft 14 and also controls the robot. The inclination of the main unit 10 is detected. The measurement signal of the inclinometer 64 is also input.
- the operation of the disaster relief robot configured as described above is as follows.
- This robot uses the output signal of the mounted inclinometer 64 without any visual inspection when a fall accident due to a cliff or a collapsed area is expected in a disaster area. Detects abnormal inclination and issues an alarm to alert the operator.Also, if the front crawler 12F has fallen into a depressed area, re-establish its posture to prevent the entire fall. Can be.
- Fig. 6 (a) in an area where a fall accident is expected, the front door 12F is turned so that its tip is located in front of the robot body 10
- the rear roller 12 R is driven in an exploration posture such that the tip is located on the side of the center of gravity of the main body 10.
- the robot body 10 is useful for turning forward (Fig. 2 (b)).
- the crawler 12F will fall completely to the sinking land if it is a sinking Japanese, and the front part of the robot body 10 will land on the ground just before the sinking ground (same as above).
- the front crawler 12F is idle or has an abnormally light load, and the inclinometer 6 also indicates an abnormal inclination state, so that automatic judgment can be made.
- the operator who reports the abnormality that occurs at this time reverses the traveling motor 26 to apply sudden braking and stops the robot main body 10.
- the front roller 12F is turned upward to return to the reference posture in a state where the front ends of the front and rear crawlers 12F and 12R are close to each other ((d) in the same figure). Since the turning trajectories of the front and rear crawlers 12F and 12R do not overlap each other, this turning operation can be easily performed.
- FIG. 7 (a) when berthing at the step in the exploration posture, the front crawler 12F is turned upward and the tip is hung on the top of the step (FIG. 7 (b)).
- the front and rear crawlers 12F and 12R are turned downward to lift the robot main body 10 ((c) in the same figure), and when the bottom of the robot main body 10 becomes larger than the top of the step. Stop the turning surface and move forward as it is ((d) in the same figure).
- ⁇ and the rear crawler 12R reach the step slope, turn the rear end of the rear crawler 12R upward and turn it.
- the tip is advanced while the tip side is in close contact with the slope (Fig. (E)).
- the turning shaft 14 is equipped with the turning angle detection encoder 44, even if the transmission system between the crawler 12 and the power source is cut off, the turning angle can be detected.
- the disaster rescue robot configured in this way has a front and rear crawler Since the spacing between the rotation axes 14 of F and 12R is increased, as shown in Fig. 8 (a), the robot's storage attitude and the reference attitude (the same Various postures can be taken, such as Fig. (B)), negotiation posture (Fig. (C)), and steep slope climbing posture (Fig. (D)).
- a winding pinch is provided at the front or rear of the robot body 10, one end of a wire lobe is wound on a tree or rock, and the other end is wound with a winding wire.
- Winding (climbing) or rewinding (dragging) can be done with a touch to assist in climbing or falling and to prevent falling.
- the disaster rescue robot according to the present invention has a greatly improved ability to climb over steps, has several times the capacity of conventional ones, and has a tilling accident even when returned to a depressed area.
- the rescue equipment can be transported safely at outdoor disaster sites.
- the drive mechanism can be prevented from being damaged and can be restored by simple repairs, so that many rescue materials can be transported safely and reliably in a short time.
- FIG. 9 the pilot 71 for remote control has four built-in angle detectors 72a, 72b.72c.72d built in, and the Attachment knobs 73a, 73b. 73c, 73d for attitude control.
- the four face rotation angle detectors 7 2 a, 7 2 b, 7 2 c, and 72 d are operated by the operator.
- the four crawlers 1 2 a, 1 2 b, 1 2 c, 1 of the mouth body 10 This sets the target use of each turning angle when remotely controlling each turning angle in 2d manually.
- the four knobs 7 3a, 7 3b, 7 3c, and 7 3d have a flat shape and are marked at one end in these hand directions with marks 7 4a, 7 4b, 7 4c, and 7 4 d It is arranged at two places on both sides of the pilot 71.
- the operator can determine the four channels 12 a, 12 b, 12 c, 1 Since the angle of each 2d surface can be grasped intuitively, the responsiveness of remote control is improved.
- FIG. 11 is a diagram showing the interconnection between the pilot 71, the controller 82, and the robot main body 10 according to the steering controller.
- Target angle signal 7 5 a, 7 2 b, 7 2 c, 72 d a, 75 b. 75 c, 75 d are input signals of the controller 82.
- This control device 82 outputs each swing drive voltage signal 80 as 80 b.
- each turning angle detector 44 a, 44 b. 4 c. 44 d detects these turning angle signals 8 la, 81 b, 81 c, 8 1 d.
- control circuit 88 is, for example, an amplifier that performs PID control and the like, and its output has a built-in power amplifier that generates a voltage sufficient to drive the swing motor 36.
- FIG. 13 is a flowchart when the steering control device is operated using a microcomputer.
- a turning angle target value signal 75 is input from the turning angle detector 72.
- the plane turning angle detector 72 is a potentiometer for multi-plane turning, the output signal is a voltage, and the turning target value signal 75 is input using an AZD converter.
- the plane rotation angle detector 72 is an incremental two-phase output pulse encoder, its output signal is a serial pulse signal having a logical output voltage (or current). Input the target value signal 75 by using.
- the plane turning angle detector 72 is an absolute type pulse encoder, its output signal is a parallel pulse signal having a logical output voltage (or current).
- the surface target input signal 75 is input using the parallel peripheral input.
- step 102 the actual turning angle of the crawler is input as a feedback signal 81 from the turning angle detector 44.
- the turning angle target value signal 75 and the feedback signal 81 are compared to calculate the angle difference. This angle difference is positive if it is less than 180 degrees clockwise, and negative if it is less than 180 degrees counterclockwise.
- Step 104 has a dead zone provided in the steering control system.
- step 105 If the absolute value of the angle difference is smaller than the predetermined value set as the dead zone, the process proceeds to step 105, and nothing is output to the turning motor 36. On the other hand, if it is larger, proceed to step 106 and check the positive or negative value of the angle difference. If the angle difference is a positive value, the process proceeds to step 107, where a positive voltage is supplied to the turning motor 36 to perform normal rotation. Conversely, if the angle difference is a negative value, the process proceeds to step 108, where a negative voltage is supplied to the turning motor 36 to perform reverse rotation. In step 109, it is determined whether to continue upon receiving a signal indicating occurrence of an abnormality or to terminate upon receiving a termination instruction. ⁇ If it is continued, return to step 101 to repeat the above operation, but if it is finished, end this program.
- FIG. 14 The configuration of the robot main body 10 is the same as that in Fig. 10, and any one of the four control systems will be sharpened below to simplify sharpening.
- knobs 93 for controlling the mouth opening posture are mounted so as to turn the axis of the turning angle detector 92. .
- the surface rotation angle detector 92 is driven by a small motor 96 via gears 95 and 97.
- a mark 94 is written on one end of the knob 93 in the hand direction. Therefore, the present embodiment will be described with reference to the block diagram of FIG.
- the output signal 99 generated by the plane turn angle detector 92 stored in the pilot 91 is transmitted to the robot by the controller 89. This is compared with the turning angle signal 81 of the turning angle detector 44 stored in the main unit 10.
- the signal of the difference is output to the control circuit 88 of the turning motor 36 of the robot body 10 and the control surface 98 of the small motor 96 of the controller 91, respectively.
- the output signal 99 from the turning angle detector 92 is treated as the turning angle target value signal, and the turning angle signal 81 from the turning angle detector 44 is fed back. Treat as a signal. Therefore, the turning surface motor 36 attached to the robot main body 10 generates a force to turn the crawler to the angle set by the surface rotation angle detector 92 of the pilot 91.
- the turning angle signal 81 from the turning angle detector 44 is treated as the turning angle target value signal of the turning angle detector 92, and the turning angle detector 92
- the output signal 99 from is handled as a feedback signal. Therefore, the smaller the motor 96 attached to the pilot 91, the further away from the current value of the rotoscope angle detector 44, the more it returns to the current value of the attitude of the crawler of the robot body 10. Generates power.
- the flow chart for the case of maneuvering using a microcomputer is similar to the flow chart of FIG. 13 described above.
- the pilot 91 The force of the small motor 96 to turn the knob 93 reversely toward the current value of the crawler angle also increases, and the operator needs to apply force to face the knob 93. That is, by applying the bilateral control means to the steering control device, the attitude of the crawler of the robot main body 10 can be intuitively recognized from the turning angle of the knob 93 of the pilot 91, and the load condition of the crawler You can feel it as turning resistance when facing the knob.
- the baila described in Fig. 15 The teleral system is known as a symmetric type in academic societies and the like, but the other bilateral control methods such as the force feedback type impedance type and the like are replaced with the symmetric type of the above embodiment, and It can also be configured.
- FIG. 16 the turning surface and driving mechanism of the disaster relief robot are the same as those shown in FIG. 1 to FIG.
- the disaster relief robot is running in a depression area with cliffs, etc., and the operator determines that preparations should be taken to prevent a fall in case of a fall, it is attached to the remote control transmitter 46.
- the “fall prevention switch” (not shown) is inserted.
- the processing shown in FIG. 16 is started.
- the turning angles of the front and rear crawlers 12 F and 12 R of the robot body 10 are controlled by the turning motor drive power supply 58, and as shown in FIG. 2F is the turning surface angle 1 extended in front of the robot body] 0, and the rear crawler 12R is set to the turning angle 2 extended in the direction of the center of gravity G.
- Such a turning attitude is referred to as an exploration attitude (step 201).
- the gain in the control loop of the speed control system of the traveling motor 26 of the front roller 12F is set to an extremely low value.
- the proportional gain / integral gain of the control loop of the traveling motor 26 is adjusted to be low, or the current limit and the torque limit of the traveling motor drive servo power supply unit 56 are set to set a fixed plant. It is conceivable that the above-mentioned surface rolling torque cannot be generated.
- the control loop gain of the traveling motor 26 of the rear crawler 12R is set to a value sufficient to achieve the target speed given from the control device 50 regardless of the load applied to the rear crawler 12R. You.
- the traveling control is mainly performed by the driving force of the traveling motor 26 of the rear crawler 12R, and the traveling motor 26 of the front roller 12F, for example, reduces the mechanical loss of the speed reducer 28. Only the torque to compensate is output.
- the reason that the traveling motor 26 of the front crawler 1 2F rolls at a speed corresponding to the target speed is mainly that the front crawler 1 2F is in contact with the ground and the rear crawler 1 2F
- the main body of the robot 10 is propelled by the motive power of the 2R traveling motor 26, and the front crawler 12F is forcibly driven by the friction with the ground, thereby driving the front crawler 12F.
- Motor 26 is forcibly facing.
- one of the front crawlers 12F hits a cliff or a depression, and the other three crawlers stop the collapse of the posture, but one of the front crawlers 12F comes into contact with the air enough to stop the mouth.
- the crawler cannot support the weight, one of the crawlers 1 2F loses the frictional force with the ground and cannot be driven from the ground.
- the control loop gain is set low for the surface rotation speed of the traveling motor 26, the detected surface rotation speed has a large positive or negative rotational speed deviation compared to the target speed command value (
- the motor power is weaker than the power loss, the number of detected surface turns will be lower than the target speed command value.
- the entire front crawler 12F may fall off the ground and lean forward.
- Such a state can be determined by monitoring the output of the useful clinometer 64 that detects the useful slope of the robot body 10.
- the robot body 10 may not always tilt. That is, as described above, one of the front crawlers 12F (for example, the left side) moves away from the ground, and the other three crawlers prevent the collapse of the posture.
- the deviation of the speed control system of the left front crawler 12F it is detected that the left front crawler 12F is approaching a cliff or the like.
- Threshold values T O of J 0 and the previous crawler load T are respectively obtained and stored in a predetermined memory.
- the above threshold value is obtained by calculating an average value for one period, or by calculating a variance or a standard deviation for one period (step 202).
- control device 50 sets the load T of the front crawler 12 F to be equal to or less than the threshold value TO. It is determined whether or not the angle is detected (step 203), and it is determined whether or not the detected angle of the inclinometer 64 is equal to or greater than the above-mentioned plant 0 (step 204).
- the process proceeds to the next step 205.
- the depression in front is a shallow depression that allows the robot to move forward and land, or a deep cliff that falls as it moves forward.
- a surface rotation command for decelerating the robot is output to the traveling motor driving power supply device 56, and the driving of the traveling motor 26 is controlled.
- the robot is decelerated.
- a turning command for erecting the front crawler 12F and positioning the tip 12a vertically downward is output to the turning motor driving power supply 58, and the turning motor 36 is turned on. Drive controlled.
- the front crawler 12F is turned to the main body weight center G side by a predetermined angle, and the hand direction of the front crawler 12F is vertical.
- the user is placed in the upright posture (step 205).
- the drive of the traveling motor 26 is controlled so that the process of traveling forward at a low speed and the predetermined distance is continuously performed.
- the continuous processing of the slow speed advance and the slow speed retreat is repeatedly performed for one or more surfaces (step 206). While such processing is being performed, it is determined whether or not the load T of each of the left and right front rollers 12F is larger than the threshold plant T O (step 207). As a result, if it is determined that the load T of the left and right front crawlers 12 F is larger than the threshold value TO, the shallow depression is sufficient to be grounded with the left and right front crawlers 12 F standing upright. Assuming that it is a low cliff, it is judged that it is possible to move forward and land as shown in Fig. 17 (f). The hand KI is then moved to step 208.
- the two wheels are not grounded even if the left and right front crawlers 12 F are upright. Assuming that the cliff is somewhat high, it is judged that it will fall if it moves forward as shown in Fig. 17 (e). Then the tongue moves to step 209.
- step 208 a command to apply the engine brake to the rear crawler 12R is output to the traction motor drive power supply unit 56, and the traction motor 26 of the rear crawler 12R is turned off. Is done.
- a command is issued by the previous crawler 12 F to make the vehicle travel at a very low speed. For this reason, the robot is advanced at a very low speed with the engine brake applied to the rear crawler 12R.
- the front surface crawler 12 F is gradually turned from the upright posture to the main body weight G side. 36 is drive-controlled. Therefore, as a robot, the mouth robot main body 10 can descend with a stable posture without abnormally leaning forward and land safely (step 208).
- step 209 first, the drive of the traveling motor 26 is controlled so as to stop the robot, and is temporarily stopped. Next, the drive of the traveling motor 26 is controlled so that the robot travels backward, and the robot travels backward. Simultaneously with this retreat, the tip 12a of the front crawler 12F extending forward of the robot body 10 as shown by the arrow E in Fig. 17 (g) is attached to the robot body 1a.
- the turning angle of the front crawler 12 F is controlled so as to be gradually positioned on the true center of gravity G through above 0, and the turning angle 6 of the front crawler 12 F is eventually set to zero. That is, the front crawler 12 F is set to the reference position.
- the front crawler 12F is returned from a state in which it protrudes to an inclined surface such as a cliff to a state in which it is in contact with the ground in front of the inclined surface, and the fall is avoided.
- the drive motor 26 is driven and controlled so that the robot is stopped when the front mouth 12F is grounded on the ground in front of the inclined surface.
- an alarm signal is sent to the remote control transmitter 46 via the remote control receiver 48 to call attention to the operator.
- a buzzer (not shown) provided in 6 may be sounded or a lamp may be turned on.
- the operator can switch to manual control. As an operator, check the height of the cliff by yourself, etc., whether it is possible to descend manually by remote control, select another route, or go up and down a steep slope (not shown) attached to the robot body 10 It is determined whether it is necessary to forcibly break through the course even by using the take-up winch, and the remote control transmitter 46 is operated to drive the robot safely according to this determination. As described above, according to the present embodiment, it is automatically and accurately determined that there is a possibility that the robot will fall down based on the inclination angle of the mouth bot body 10 and the load applied to the front chiller 12 F.
- the robot after it is determined that the robot may fall down, it is determined whether the robot is a low cliff that can move forward further or a high cliff that falls down when moving forward.
- determination processing can be omitted in some cases. That is, when it is determined that there is a risk of falling, the vehicle may be uniquely returned to the state shown in FIG. 17 (f), and then the operation may be left to the manual operation of the operator.
- the falling surface evacuation operation is a force that causes the front part of the front roller 12F that has been extended forward to turn backward while the robot is retracted; this operation is an example.
- the degree of freedom of the turning surface is as large as 360 ', and the characteristics of the crawler that can take an arbitrary turning posture are used, and if the fall surface can be reliably avoided, the turning can be performed.
- the mode of operation is arbitrary.
- the load applied to the front crawler 12 F is reduced by reducing the control loop gain of the speed control system of the front crawler 12 F ⁇ traveling motor 26, and the deviation of this speed control system
- the traveling motor is a DC motor
- it can be detected based on the armature current if it is a DC motor, or it can be detected based on the output signal of an AC servo amplifier if it is an AC servo motor.
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Control Of Multiple Motors (AREA)
- Emergency Lowering Means (AREA)
Description
Claims
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US07/983,583 US5337846A (en) | 1990-08-08 | 1991-08-08 | Disaster relief robot and operation controller therefor |
DE69122872T DE69122872T2 (de) | 1990-08-08 | 1991-08-08 | Hilfsroboter für katastrophen und seine betriebs-kontrolleinrichtungen |
CA002088356A CA2088356A1 (en) | 1990-08-08 | 1991-08-08 | Disaster relief robot and operation controller therefor |
EP91914221A EP0541810B1 (en) | 1990-08-08 | 1991-08-08 | Disaster relief robot and its operation controller |
Applications Claiming Priority (6)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2210922A JP2678813B2 (ja) | 1990-08-08 | 1990-08-08 | 災害救援ロボット |
JP2/210922 | 1990-08-08 | ||
JP2280947A JP2528032B2 (ja) | 1990-10-19 | 1990-10-19 | 四分割独立旋回式トラックフレ―ムを備える自走ロボットの遠隔操縦装置 |
JP2/280947 | 1990-10-19 | ||
JP3/121296 | 1991-05-27 | ||
JP3121296A JP3066773B2 (ja) | 1991-05-27 | 1991-05-27 | 装軌車両の転落防止装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO1992002398A1 true WO1992002398A1 (fr) | 1992-02-20 |
Family
ID=27314220
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP1991/001061 WO1992002398A1 (fr) | 1990-08-08 | 1991-08-08 | Robot de secours en cas de catastrophe et unite associee de commande des manoeuvres |
Country Status (6)
Country | Link |
---|---|
US (1) | US5337846A (ja) |
EP (1) | EP0541810B1 (ja) |
AT (1) | ATE144474T1 (ja) |
CA (1) | CA2088356A1 (ja) |
DE (1) | DE69122872T2 (ja) |
WO (1) | WO1992002398A1 (ja) |
Families Citing this family (52)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3093866B2 (ja) * | 1992-04-21 | 2000-10-03 | 株式会社小松製作所 | 装軌車両のトラクション制御装置 |
FR2692667B1 (fr) * | 1992-06-18 | 1994-08-19 | Alsthom Cge Alcatel | Dispositif de mesure de déplacement pour véhicule, notamment pour robot tout-terrain, et véhicule équipé d'un tel dispositif. |
US6729071B1 (en) * | 1995-10-02 | 2004-05-04 | Ohi Seisakusho Co., Ltd. | Device for automatically controlling opening and closing of a vehicle slide door |
JP3465735B2 (ja) * | 1995-10-02 | 2003-11-10 | 株式会社大井製作所 | 車両用スライドドアの自動開閉制御装置 |
JP3754139B2 (ja) * | 1996-08-06 | 2006-03-08 | 株式会社トプコン | レーザ基準レベル装置 |
US6263989B1 (en) * | 1998-03-27 | 2001-07-24 | Irobot Corporation | Robotic platform |
US6662889B2 (en) * | 2000-04-04 | 2003-12-16 | Irobot Corporation | Wheeled platforms |
US20040216932A1 (en) * | 2001-07-09 | 2004-11-04 | United Defense, Lp | Hybrid wheel and track vehicle drive system |
US8000837B2 (en) | 2004-10-05 | 2011-08-16 | J&L Group International, Llc | Programmable load forming system, components thereof, and methods of use |
US7581605B2 (en) * | 2006-02-22 | 2009-09-01 | Mga Entertainment, Inc. | Quad tracked vehicle |
JP4635259B2 (ja) * | 2006-03-10 | 2011-02-23 | 独立行政法人産業技術総合研究所 | クローラロボット |
US7475745B1 (en) | 2006-05-11 | 2009-01-13 | Deroos Bradley G | High mobility vehicle |
US8326469B2 (en) * | 2006-07-14 | 2012-12-04 | Irobot Corporation | Autonomous behaviors for a remote vehicle |
US8108092B2 (en) | 2006-07-14 | 2012-01-31 | Irobot Corporation | Autonomous behaviors for a remote vehicle |
US8843244B2 (en) * | 2006-10-06 | 2014-09-23 | Irobot Corporation | Autonomous behaviors for a remove vehicle |
US7891446B2 (en) * | 2006-10-06 | 2011-02-22 | Irobot Corporation | Robotic vehicle deck adjustment |
US7843431B2 (en) * | 2007-04-24 | 2010-11-30 | Irobot Corporation | Control system for a remote vehicle |
US8644991B2 (en) * | 2006-10-06 | 2014-02-04 | Irobot Corporation | Maneuvering robotic vehicles |
US7784570B2 (en) | 2006-10-06 | 2010-08-31 | Irobot Corporation | Robotic vehicle |
EP2112963B1 (en) | 2006-10-06 | 2018-05-30 | iRobot Defense Holdings, Inc. | Robotic vehicle with tracks and flippers |
US8413752B2 (en) * | 2006-10-06 | 2013-04-09 | Irobot Corporation | Robotic vehicle |
US7654348B2 (en) | 2006-10-06 | 2010-02-02 | Irobot Corporation | Maneuvering robotic vehicles having a positionable sensor head |
EP2144659A1 (en) | 2007-05-07 | 2010-01-20 | Raytheon Sarcos, LLC | Method for manufacturing a complex structure |
EP2146826A2 (en) * | 2007-05-08 | 2010-01-27 | Raytheon Sarcos, LLC | Variable primitive mapping for a robotic crawler |
US8255092B2 (en) * | 2007-05-14 | 2012-08-28 | Irobot Corporation | Autonomous behaviors for a remote vehicle |
EP2006178B1 (en) * | 2007-06-19 | 2010-12-15 | Ford Global Technologies, LLC | A hybrid vehicle, a hybrid vehicle propulsion system and a method for an exhaust gas treatment device in a such a system |
WO2009009673A2 (en) | 2007-07-10 | 2009-01-15 | Raytheon Sarcos, Llc | Modular robotic crawler |
US8540040B2 (en) * | 2007-11-07 | 2013-09-24 | Gse Technologies, Llc | Multi-purpose ground vehicle |
DE102008014139A1 (de) * | 2008-03-13 | 2009-09-17 | Terex-Demag Gmbh | Raupenkran sowie Verfahren zur Einstellung einer Grund-Arbeitsposition eines derartigen Raupenkrans |
EP2342113B1 (en) * | 2008-09-30 | 2013-01-16 | Nissan Motor Co., Ltd. | Control-operation assisting device and control-operation assisting method |
US8392036B2 (en) | 2009-01-08 | 2013-03-05 | Raytheon Company | Point and go navigation system and method |
US8935014B2 (en) | 2009-06-11 | 2015-01-13 | Sarcos, Lc | Method and system for deploying a surveillance network |
DE102009051583A1 (de) * | 2009-10-21 | 2011-04-28 | IPR-Intelligente Peripherien für Roboter GmbH | Robotersystem und Verfahren zum Verlegen eines Schienenstrangs |
US20110190933A1 (en) * | 2010-01-29 | 2011-08-04 | Andrew Shein | Robotic Vehicle |
US9061706B2 (en) * | 2010-09-28 | 2015-06-23 | Vitaly Grossman | Tracked vehicle with multiple self-contained tracked drives and remote tracked drive jettisoning capability |
US8983717B2 (en) * | 2010-12-21 | 2015-03-17 | Ford Global Technologies, Llc | Vehicle camera system operable in off-road mode and method |
CN102700641A (zh) * | 2012-01-19 | 2012-10-03 | 龙梅 | 一种矿用救生舱机器人的旋转式履带 |
US8727047B2 (en) * | 2012-01-26 | 2014-05-20 | Claas Industrietechnik Gmbh | Configuration of a two-track tractor |
CN103419203A (zh) * | 2012-05-21 | 2013-12-04 | 李坚 | 一种全天型家用机器人 |
US8393422B1 (en) | 2012-05-25 | 2013-03-12 | Raytheon Company | Serpentine robotic crawler |
US9031698B2 (en) | 2012-10-31 | 2015-05-12 | Sarcos Lc | Serpentine robotic crawler |
CN103817686A (zh) * | 2012-11-19 | 2014-05-28 | 青岛理工大学琴岛学院 | 一种用于灾难救援机器人机械臂 |
US9409292B2 (en) | 2013-09-13 | 2016-08-09 | Sarcos Lc | Serpentine robotic crawler for performing dexterous operations |
RU2542827C1 (ru) * | 2013-11-22 | 2015-02-27 | Михаил Дмитриевич Косткин | Вездеход (варианты) |
WO2015079418A2 (en) * | 2013-11-28 | 2015-06-04 | Nicolaas Daniel Lombard Burger | Mining apparatus |
US9566711B2 (en) | 2014-03-04 | 2017-02-14 | Sarcos Lc | Coordinated robotic control |
CN105667618A (zh) * | 2016-03-22 | 2016-06-15 | 南京工程学院 | 一种可越障的仿生底盘 |
US10471589B2 (en) | 2016-09-20 | 2019-11-12 | Foster-Miller, Inc. | Remotely controlled packable robot |
US10414039B2 (en) | 2016-09-20 | 2019-09-17 | Foster-Miller, Inc. | Remotely controlled packable robot |
US10889340B2 (en) | 2017-07-07 | 2021-01-12 | Foster-Miller, Inc. | Remotely controlled packable robot with folding tracks |
US11331818B2 (en) | 2018-10-11 | 2022-05-17 | Foster-Miller, Inc. | Remotely controlled packable robot |
WO2023201440A1 (en) * | 2022-04-21 | 2023-10-26 | Soucy International Inc. | Angular controlling system for a track system, track system and vehicle having same, and methods for performing angular control of same |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63203483A (ja) * | 1987-02-18 | 1988-08-23 | Res Dev Corp Of Japan | 能動適応型クロ−ラ走行車 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3730287A (en) * | 1971-05-17 | 1973-05-01 | Nasa | Vehicle for use in planetary exploration |
JPS56138071A (en) * | 1980-03-29 | 1981-10-28 | Toshiba Corp | Mobile monitoring equipment |
JPS592974A (ja) * | 1982-06-26 | 1984-01-09 | Toshiba Corp | 4輪クロ−ラ走行車 |
EP0197020A1 (fr) * | 1985-03-09 | 1986-10-08 | ACEC, Société Anonyme | Véhicule télécommandé pour inspection et intervention en milieux hostiles |
JPS63270A (ja) * | 1986-06-18 | 1988-01-05 | Nitta Zerachin Kk | ゼラチンチューイングゼリー |
JPS63203484A (ja) * | 1987-02-18 | 1988-08-23 | Res Dev Corp Of Japan | 不整地移動車用姿勢保持機構 |
US4977971A (en) * | 1989-05-17 | 1990-12-18 | University Of Florida | Hybrid robotic vehicle |
FR2651201B1 (fr) * | 1989-08-31 | 1991-10-25 | Framatome Sa | Vehicule a chenilles inclinables. |
FR2651200B1 (fr) * | 1989-08-31 | 1991-10-18 | Framatome Sa | Vehicule a propulseurs chenilles inclinables. |
FR2653732B1 (fr) * | 1989-10-31 | 1994-12-09 | Alsthom Cge Alcatel | Vehicule d'intervention a configuration variable pour sols accidentes. |
-
1991
- 1991-08-08 DE DE69122872T patent/DE69122872T2/de not_active Expired - Fee Related
- 1991-08-08 CA CA002088356A patent/CA2088356A1/en not_active Abandoned
- 1991-08-08 WO PCT/JP1991/001061 patent/WO1992002398A1/ja active IP Right Grant
- 1991-08-08 US US07/983,583 patent/US5337846A/en not_active Expired - Fee Related
- 1991-08-08 AT AT91914221T patent/ATE144474T1/de active
- 1991-08-08 EP EP91914221A patent/EP0541810B1/en not_active Expired - Lifetime
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63203483A (ja) * | 1987-02-18 | 1988-08-23 | Res Dev Corp Of Japan | 能動適応型クロ−ラ走行車 |
Also Published As
Publication number | Publication date |
---|---|
EP0541810B1 (en) | 1996-10-23 |
EP0541810A1 (en) | 1993-05-19 |
DE69122872D1 (de) | 1996-11-28 |
US5337846A (en) | 1994-08-16 |
CA2088356A1 (en) | 1992-02-09 |
ATE144474T1 (de) | 1996-11-15 |
EP0541810A4 (en) | 1993-03-12 |
DE69122872T2 (de) | 1997-03-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO1992002398A1 (fr) | Robot de secours en cas de catastrophe et unite associee de commande des manoeuvres | |
JP2530139B2 (ja) | 関節連結車 | |
US7798264B2 (en) | Reconfigurable balancing robot and method for dynamically transitioning between statically stable mode and dynamically balanced mode | |
US20070208483A1 (en) | Safety control system for electric vehicle | |
KR20180079429A (ko) | 수직 장애물을 가로지르는 시스템 및 방법 | |
US11584181B2 (en) | Self leveling autonomous guided vehicle | |
JPS5973372A (ja) | 走行体 | |
KR101457257B1 (ko) | 계단을 이동할 수 있는 운송 시스템. | |
JPS5925712B2 (ja) | 走行体 | |
JP2678813B2 (ja) | 災害救援ロボット | |
JP3066773B2 (ja) | 装軌車両の転落防止装置 | |
JPH09240521A (ja) | 災害救援ロボット | |
CN213852864U (zh) | 智能救灾机器人 | |
JPH0228152Y2 (ja) | ||
JP2000072060A (ja) | 傾斜地走行に適した作業車とその使用方法 | |
JP2021016373A (ja) | 走行車の自動回転システムと方法、及びそれを搭載した農作業用走行車、並びに無人自動走行作業車 | |
JP2004050966A (ja) | 脚型走行方式とその装置 | |
JPS6033172A (ja) | 走行・歩行装置 | |
CN112415625A (zh) | 一种生命探测救援设备 | |
US20230047500A1 (en) | Inclination control system for tracked vehicle | |
KR102642503B1 (ko) | 자율주행 무인 농약 살포차량의 주행안전 시스템 | |
JPH0248288Y2 (ja) | ||
JPS60174367A (ja) | 自走作業車 | |
EP4309482A1 (en) | Robotic lawn tool with lift sensor | |
Langner et al. | Controlling wheelchair direction on slopes |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AK | Designated states |
Kind code of ref document: A1 Designated state(s): CA US |
|
AL | Designated countries for regional patents |
Kind code of ref document: A1 Designated state(s): AT CH DE FR GB IT SE |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2088356 Country of ref document: CA |
|
WWE | Wipo information: entry into national phase |
Ref document number: 1991914221 Country of ref document: EP |
|
WWP | Wipo information: published in national office |
Ref document number: 1991914221 Country of ref document: EP |
|
WWG | Wipo information: grant in national office |
Ref document number: 1991914221 Country of ref document: EP |