Mobile Robot
The mobile robot's dual-arm mechanism with biased installation and adjustable support parts stabilizes its position and posture on uneven terrain, addressing operational instability and shock absorption for precise tasks.
Patent Information
- Application Number
- JP2023500211
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-02-18
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2041-02-18
AI Technical Summary
Existing mobile robots with multi-joint arms struggle to maintain their position and posture while navigating uneven terrain, leading to potential shocks and operational instability during tasks like precise dispensing and stirring.
The mobile robot incorporates a dual-arm mechanism with a biased installation towards the moving direction, featuring a first support part with swinging wheels and elastic elements, and a second support part with a linear actuator for contact adjustment, ensuring constant ground contact and shock absorption.
This design allows the mobile robot to stabilize its position and posture on uneven surfaces, preventing shocks and maintaining precision during operations such as dispensing and stirring.
Smart Images

Figure 0007579958000001 
Figure 0007579958000002 
Figure 0007579958000003
Abstract
Description
[Technical field]
[0001] The present invention relates to a mobile robot having a multi-joint arm mounted on a moving mechanism (e.g., a dolly). In particular, the present invention relates to a mobile robot that grasps a work target, moves to a work location (e.g., a workbench), and performs various tasks. [Background technology]
[0002] In recent years, there has been research and development of mobile robots, such as dual-arm robots with multi-joint arms and robot arms mounted on autonomously movable carts. These mobile robots can carry a work target, move to a workbench, and use various tools on the workbench to perform various tasks automatically.
[0003] Background art in this technical field includes Japanese Patent Application Laid-Open No. 2017-94470 (hereinafter, Patent Document 1).
[0004] Patent document 1 describes a robot that can be easily moved and installed, and that suppresses deviations in the robot's position and posture, and that has multiple moving units and an operating unit that move the robot, and that has a fixed unit that moves at least one of the multiple moving units away from the ground surface by operating the operating unit (see abstract of Patent document 1). [Prior art documents] [Patent documents]
[0005] [Patent Document 1] JP 2017-94470 A Summary of the Invention [Problem to be solved by the invention]
[0006] Patent Document 1 describes a robot (mobile robot) having a fixing part that separates the robot from the ground surface. That is, the mobile robot described in Patent Document 1 uses the fixing part to suppress displacement of the mobile robot when the multi-joint arm is in operation, in order to suppress deviation of the position and posture of the mobile robot when the multi-joint arm is in operation.
[0007] Generally, mobile robots may move over uneven surfaces, so it is necessary to reduce the rigidity of the structure supporting the wheels in order to absorb the impacts received from the uneven surfaces when the mobile robot moves and to suppress changes in the posture of the mobile robot when it moves.
[0008] In addition, in the case of a mobile robot having a multi-joint arm, the position of the center of gravity shifts on the cart when the multi-joint arm is moved, so it is necessary to increase the rigidity of the structure supporting the wheels and suppress changes in the posture of the mobile robot when it is moving, so as not to change the position or posture of the mobile robot when the multi-joint arm is moving.
[0009] In this way, in a mobile robot having a multi-joint arm, the rigidity of the structure supporting the wheels is set depending on when the mobile robot is moving and when the multi-joint arm is operating.
[0010] For example, a mobile robot that carries a liquid to be worked on, moves to a workbench, and performs precise dispensing or mixing operations on the workbench needs to absorb shocks from uneven surfaces so as not to spill the liquid while moving, and also needs to maintain the position and posture of the mobile robot while operating to perform precise dispensing or mixing operations, i.e., to suppress changes in the posture of the mobile robot.
[0011] In other words, such a mobile robot must simultaneously absorb the shocks it receives from uneven road surfaces while moving, and maintain the position and posture of the mobile robot while in motion.
[0012] However, Patent Document 1 does not describe a mobile robot that simultaneously absorbs shocks received from uneven road surfaces while moving and maintains the position and posture of the mobile robot during operation.
[0013] Therefore, the present invention provides a mobile robot that simultaneously absorbs shocks received from uneven road surfaces while moving and maintains the position and posture of the mobile robot during operation. [Means for solving the problem]
[0014] In order to solve the above problems, the mobile robot of the present invention is a mobile robot that has a working mechanism having an articulated arm and a moving mechanism for moving the working mechanism, and that transports liquid and performs dispensing and mixing operations, The working mechanism is disposed at a position offset forward with respect to a moving direction of the moving mechanism, The working mechanism is installed so as to be tilted forward in the moving direction of the moving mechanism when the working mechanism is in operation. The moving mechanism has a first support part and a second support part that support its own weight, and the first support part swings around a swing axis. Four A swinging part and a Four A force is applied to the wheels to keep them in contact with the ground at all times. Four The second support portion has an elastic portion. The two in front A position closer to the outer periphery in the direction of movement of the moving mechanism than the center axis of the wheel between the two front wheels The present invention is characterized by having a movable body that is installed on the movable body and moves up and down by a linear actuator, and a contact portion that is installed on the movable body and comes into contact with the ground surface when extended and moves away from the ground surface when contracted. Effect of the Invention
[0015] According to the present invention, it is possible to provide a mobile robot that can simultaneously absorb shocks received from uneven road surfaces while moving and maintain the position and posture of the mobile robot while in operation.
[0016] Problems, configurations and effects other than those described above will become apparent from the following description of the embodiments. [Brief description of the drawings]
[0017] [Figure 1] FIG. 1 is an explanatory diagram illustrating the appearance of a mobile robot 1 according to a first embodiment. [Diagram 2] 2 is an explanatory diagram illustrating the structure of a moving mechanism 20 of the mobile robot 1 described in the first embodiment. FIG. [Diagram 3] 2 is an explanatory diagram illustrating the structure of a second support part 220 of the mobile robot 1 described in the first embodiment. FIG. [Figure 4] FIG. 2 is an explanatory diagram for explaining a state in which the mobile robot 1 described in the first embodiment is moving. [Diagram 5] 2 is a schematic diagram for explaining a support structure of the mobile robot 1 during movement according to the first embodiment. FIG. [Figure 6] FIG. 2 is an explanatory diagram for explaining a state in which the mobile robot 1 described in the first embodiment has moved to a work platform 50 and stopped. [Figure 7] FIG. 2 is a schematic diagram illustrating a support structure of the mobile robot 1 described in the first embodiment when the mobile robot 1 has moved to a work table 50 and stopped there. [Figure 8] 11 is a graph illustrating the time transition of a load N11F acting on a first support portion 210 and a load N21 acting on a second support portion 220 in the front of the mobile robot 1 described in the first embodiment. [Figure 9] FIG. 2 is an explanatory diagram for explaining a state in which the mobile robot 1 described in the first embodiment is working on a workbench 50. [Figure 10] 1 is a schematic diagram illustrating a support structure of the mobile robot 1 according to the first embodiment when the mobile robot 1 is working on a workbench 50. FIG. [Figure 11] 13 is a graph illustrating the time transition of a load N12F acting on a first support portion 210 and a load N22 acting on a second support portion 220 in the front of the mobile robot 1 described in the first embodiment. [Figure 12] 10 is an explanatory diagram illustrating the structure of a moving mechanism 20 of a mobile robot 1 described in a second embodiment. FIG. [Figure 13] 11 is an explanatory diagram illustrating the structure of a moving mechanism 20 of a mobile robot 1 according to a third embodiment. FIG. [Figure 14]11 is an explanatory diagram for explaining an enlarged view of the vicinity of a second support part 220 of the mobile robot 1 described in the third embodiment. FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0018] Hereinafter, an embodiment of the present invention will be described with reference to the drawings. Note that the same reference numerals are used to designate components that are substantially the same or similar in function, and descriptions thereof may be omitted if they are repeated. EXAMPLES
[0019] First, the appearance of the mobile robot 1 according to the first embodiment will be described.
[0020] Fig. 1 is an explanatory diagram for explaining the external appearance of a mobile robot 1 described in Example 1. In Fig. 1, in order to make it easier to understand the internal structure of a moving mechanism 20 of the mobile robot 1, a part of the cover of the moving mechanism 20 of the mobile robot 1 is removed so that the internal structure can be seen.
[0021] The mobile robot 1 described in the first embodiment has a working mechanism (hereinafter, referred to as a dual-arm robot 10) with an articulated arm 100, and a head 110. However, the mobile robot 1 is not limited to this. For example, the mobile robot 1 may be a combination of two robots, a single-arm right robot and a single-arm left robot. These two robots may be different types of robots. Also, the robot may have only a single arm, and is not limited by the number of arms.
[0022] The mobile robot 1 can move while autonomously estimating its own position, maintain its position and attitude, and run stably on uneven surfaces using its wheels.
[0023] The mobile robot 1 has a dual-arm robot 10 having a multi-joint arm 100 for performing various tasks, a movement mechanism 20 for moving the dual-arm robot 10, and a control unit 30 for controlling the operations of these.
[0024] The dual-arm robot 10 has two articulated arms 100 (one on the left and one on the right) with actuators built into each joint, and at the tip of each arm is a hand (gripper) 101 for grasping a work object and performing various tasks (operations).
[0025] The dual-arm robot 10 also has a head 110, and a stereo camera unit 111 having two image pickup elements and two lens units is installed (built-in) inside the head 110. In this way, the binocular stereo camera unit 111 can measure the distance to the work table and the distance to a target point on the work table, and can also observe a work target or a target marker to correct the position and posture.
[0026] The dual-arm robot 10 is installed in front of the moving mechanism 20 (in the working direction). That is, the dual-arm robot 10 is installed in a position (installation position of the dual-arm robot 10) biased toward the forward moving direction (direction of arrow A in FIG. 1) of the mobile robot 1 relative to the moving mechanism 20. This installation position of the dual-arm robot 10 allows the dual-arm robot 10 to approach the workbench.
[0027] Moreover, the double-arm robot 10 is installed so as to be inclined forward (in the working direction) relative to the moving mechanism 20. That is, the double-arm robot 10 is installed so as to tilt its waist forward in the moving direction of the mobile robot 1 (in the direction of arrow A in FIG. 1). Here, the double-arm robot 10 has a waist 105 that can be tilted in the working direction (in the direction of arrow A in FIG. 1). That is, the double-arm robot 10 can be tilted forward in the front of the mobile robot 1 (in the direction of arrow A in FIG. 1) by tilting its waist 105.
[0028] In this way, by tilting the waist 105 of the dual-arm robot 10 forward, workability on a workbench can be improved.
[0029] The moving mechanism 20 has a rotary actuator (not shown) that is driven by an operation command from the control unit 30. The power of the rotary actuator is transmitted to wheels 212 made of, for example, resin, by various power transmission means, and the wheels 212 rotate, causing the mobile robot 1 to move.
[0030] In the movement mechanism 20, the wheels 212 are called Mecanum wheels, and have a barrel-shaped member whose surface (circumference) is inclined at 45 degrees to the axle. Each wheel 212 has a rotation actuator so that the wheels can be driven independently. By adjusting and controlling the rotation direction and speed of each rotation actuator, translational movement in all directions, forward / backward and left / right, and rotational movement on the spot are possible.
[0031] The moving mechanism 20 also has a laser range finder 240 that measures the distance between the mobile robot 1 and an object such as a wall or a workbench and its own position while the mobile robot 1 is moving, and a bumper 230 that absorbs the impact when the mobile robot 1 collides with an obstacle. Since the laser range finder 240 can detect an obstacle while the mobile robot 1 is moving, the mobile robot 1 can move autonomously.
[0032] Thus, the mobile robot 1 has a position detection means for measuring the distance of the stereo camera unit 111 and the laser range finder 240, and a control unit 30 for calculating the self-position (position data) acquired by this position detection means.
[0033] The moving mechanism 20 also has a first support portion 210 and a second support portion 220 .
[0034] In this way, the mobile robot 1 has a dual-arm robot 10 having a multi-joint arm 100, and a moving mechanism 20 having a first support part 210 and a second support part 220 that support the weight of the mobile robot 1, and simultaneously absorbs shocks received from uneven road surfaces while moving (absorbing shocks from road surfaces while moving) and maintains the position and posture of the mobile robot during operations that require precision (precision operations) (maintaining position and posture during operation).
[0035] In the case of a mobile robot 1 that transports liquids such as reagents and samples as the work target (transport target) and performs precise dispensing and mixing work on a workbench, the mobile robot 1 absorbs shocks from uneven road surfaces to prevent the liquid from spilling while moving, and maintains the position and posture of the mobile robot 1 to perform precise dispensing and mixing work during operation.
[0036] In other words, such a mobile robot 1 simultaneously absorbs shocks received from uneven road surfaces while moving, and maintains the position and posture of the mobile robot 1 while in operation.
[0037] Next, the structure of the moving mechanism 20 of the mobile robot 1 according to the first embodiment will be described.
[0038] Fig. 2 is an explanatory diagram for explaining the structure of the moving mechanism 20 of the mobile robot 1 described in Example 1. In Fig. 2, the cover of the moving mechanism 20 of the mobile robot 1 is removed so that the internal structure can be seen, in order to make it easier to understand.
[0039] The movement mechanism 20 has a vehicle body 250 which is a base member of the movement mechanism 20 , a first support portion 210 , and a second support portion 220 .
[0040] The first support section 210 is a member that constantly supports the weight of the mobile robot 1. The first support section 210 has four oscillating sections 211 that can oscillate and be displaced around four oscillating axes 211s, four front, rear, left and right, four wheels 212 that are rotatably installed at the tips of the four oscillating sections 211 and driven by the power of a rotary actuator (not shown), and four displaceable elastic sections 213 that constantly apply a biasing force that brings the four wheels 212 into contact with a ground surface (for example, a floor) and generate a reliable driving force to the four wheels 212. In this way, the first support section 210 is installed at four locations, front, rear, left and right, of the moving mechanism 20.
[0041] In addition, in Example 1, the oscillating part 211 has an L-shape, an oscillating axis 211s is formed at the bend of the L-shape, an elastic part 213 is provided at the tip of one side of the L-shape, and the central axis of the wheel 212 is provided at the tip of the other side of the L-shape.
[0042] The elastic portion 213 has one end connected to the swinging portion 211 and the other end connected to the vehicle body 250. The elastic portion 213 is, for example, like a coil spring that deforms in a compression direction and generates an elastic force.
[0043] When the first support part 210 supports the weight of the mobile robot 1, the swinging part 211 swings around the swing axis 211s in the direction of the arrow M in Fig. 2. This swinging causes the elastic part 213 to deform, and a spring force acts to support the weight of the mobile robot 1. The elastic part 213 may have a damping function.
[0044] Next, the structure of the second support part 220 of the mobile robot 1 according to the first embodiment will be described.
[0045] FIG. 3 is an explanatory diagram illustrating the structure of the second support part 220 of the mobile robot 1 described in the first embodiment.
[0046] The second support part 220 is an operating mechanism (linear actuator) that changes its state between when the mobile robot 1 is moving and when the mobile robot 1 is operating, and has a linear motion part 222, a moving body 223 that moves up and down by the linear motion part 222, a contact part 221 that is installed on the moving body 223 that moves up and down by the linear motion actuator (linear motion part 222) and comes into contact with the ground surface when extended (when operating) and moves away from the ground surface when contracted (when moving), a photointerrupter 224 that detects excessive movement of the moving part 223, and a frame 225 that holds these.
[0047] In this manner, the second support portion 220 has a linear actuator that moves the moving body 223 in the vertical direction, and the contact portion 221 moves in the vertical direction via the moving body 223 by this linear actuator.
[0048] The linear motion part 222 includes a rotary motor 2220 , a worm gear 2221 , and a screw mechanism 2222 .
[0049] In the linear motion section 222, the rotary shaft of the rotary motor 2220 rotates, and the rotational force is transmitted to the screw mechanism 2222 via the worm gear 2221, causing the screw mechanism 2222 to rotate.
[0050] The rotary motor 2220 has a load torque detection means for detecting the load torque acting on the rotary motor 2220. For example, the load torque detection means applies a constant voltage to the rotary motor 2220 and detects a current value that changes based on the load of the rotary motor 2220.
[0051] The worm gear 2221 can also suppress rotation of the rotary shaft of the rotary motor 2220. When a thrust force in the thrust direction is generated in the screw mechanism 2222, the screw mechanism 2222 tries to rotate in the rotation direction. For this reason, the worm gear 2221 is installed between the screw mechanism 2222 and the rotary motor 2220, and the worm gear 2221 suppresses reverse rotation of the rotary shaft of the rotary motor 2220.
[0052] The moving body 223 is moved by the linear motion part 222, and has a nut part (not shown) at a portion through which the screw mechanism 2222 penetrates, and the screw mechanism 2222 fits into this nut part. Then, as the screw mechanism 2222 rotates, the moving body 223 moves in the direction of the arrow Y in FIG. 3 (up and down direction).
[0053] Moreover, the moving body 223 has a nut portion into which the screw mechanism 2222 fits, and also has a translation guide (not shown) that guides the movement of the moving body 223. That is, the moving body 223 fits into the screw mechanism 2222 at the nut portion, and moves inside the frame 225 in the direction of the arrow Y in FIG. 3 via the translation guide.
[0054] In addition, in Example 1, the movable body 223 has an approximately rectangular parallelepiped shape, and the nut portion is formed at approximately the center of the horizontal cross section of the movable body 223 so as to penetrate in the direction of arrow Y in Figure 3 so that the rotational force of the screw mechanism 2222 acts evenly on the movable body 223.
[0055] In the first embodiment, the translation guides are provided on the left and right end faces in the longitudinal direction of the movable body 223 so that the movable body 223 moves stably in the direction of the arrow Y in Fig. 3. The translation guides may be provided on the left and right sides of the inner side of the frame 225.
[0056] Furthermore, the moving body 223 is provided with a contact portion 221 that comes into contact with the ground surface via a spherical bearing 227 .
[0057] In addition, spherical bearing 227 is installed to bring the end face of contact portion 221 into contact with the ground surface so that the end face of contact portion 221 (the surface at which contact portion 221 comes into contact with the ground surface) conforms to the ground surface, even if the ground surface is inclined.
[0058] In this way, because the second support portion 220 has a spherical bearing 227, even if the ground surface is inclined, the end face of the contact portion 221 can contact the ground surface so that the end face of the contact portion 221 conforms to the ground surface.
[0059] Then, the moving body 223 descends, causing the contact portion 221 to come into contact with the ground surface. As the moving body 223 descends and the load torque detection means detects the load (current value) of the rotary motor 2220 (change in the load (current value) of the rotary motor 2220) when the contact portion 221 comes into contact with the ground surface, the control unit 30 determines that the contact portion 221 has come into contact with the ground surface, and stops the rotary motor 2220, thereby stopping the moving body 223.
[0060] Furthermore, when the contact portion 221 does not contact the ground surface due to the state of the ground surface, the photointerrupter 224 detects excessive movement of the moving portion 223, stops the rotation motor 2220, and stops the moving body 223. This prevents the moving body 223 from descending below a predetermined position.
[0061] In the first embodiment, the contact portions 221 are provided on the moving body 223 in two positions, on the left and right of the screw mechanism 2222, approximately evenly spaced from the screw mechanism 2222, in order to stably maintain the position and posture of the mobile robot 1.
[0062] Fixing members 226 are installed on the left and right outer sides of the frame 225. The second support portion 220 is fixed to the vehicle body 250 by the fixing members 226.
[0063] Next, the features of the first support portion 210 and the second support portion 220 will be described.
[0064] 2, in the first support section 210, the wheels 212 are constantly in contact with the ground surface due to the elastic sections 213, so that the first support section 210 constantly supports the weight of the mobile robot 1. The elastic sections 213 have a predetermined optimum spring constant for the wheels 212 to absorb shocks received from an uneven road surface (passively cushioning external forces received from an uneven road surface).
[0065] 3, in the second support section 220, the contact section 221 moves in the vertical direction by the linear motion section 222 via the moving section 223. In other words, the contact section 221, the moving section 223, and the linear motion section 221 can support the own weight of the mobile robot 1 as necessary.
[0066] The contact portion 221 of the second support portion 220 has higher rigidity than the elastic portion 213 of the first support portion 210. This makes it possible to simultaneously and stably absorb shocks received from uneven road surfaces while moving and maintain the position and posture of the mobile robot 1 while it is operating.
[0067] Furthermore, the linear motion portion 222 of the second support portion 220 has higher rigidity than the elastic portion 213 of the first support portion 210 .
[0068] Furthermore, in the mobile robot 1, the second support part 220 is installed at least in one location outside (forward in the moving direction of the mobile robot 1) in the moving direction (synonymous with the moving direction of the moving mechanism 20) of the mobile robot 1, out of the installation position (forward) of the first support part 210 on the side of the mounting position of the dual-arm robot 10 (installation position in the direction of arrow A in Figure 1: installation position of the dual-arm robot 10) of the mobile robot 1.
[0069] In particular, the second support part 220 is installed forward in the movement direction of the mobile robot 1 from the central axis of the two front wheels 212 of the first support part 210. The installation position of the second support part 220 is determined depending on the usage mode of the double-arm robot 10, and may be located outside (closer to the outer periphery) than the installation position of the first support part 210 with respect to the working direction (movement direction) of the double-arm robot 10.
[0070] In the first embodiment, only one second support unit 220 is installed between the two front wheels 212 and further forward than the central axis of the two front wheels 212. In this manner, in the first embodiment, one second support unit 220 is installed further outward than the installation position of the first support unit 210 with respect to the forward movement direction of the double-arm robot 10.
[0071] Next, the state of the mobile robot 1 according to the first embodiment during movement will be described.
[0072] FIG. 4 is an explanatory diagram for explaining a state in which the mobile robot 1 described in the first embodiment is moving.
[0073] The mobile robot 1 moves from an initial position toward the workbench 50 to perform dispensing and mixing operations on the workbench 50. The mobile robot 1 can also transport containers and container trays that contain liquids such as reagents and samples that are the objects of the operations.
[0074] On the workbench 50, there are placed test tubes 501 for containing liquid such as a reagent or sample to be worked on, and a pipette 502 for dispensing a predetermined amount of liquid by aspirating or dispensing the liquid.
[0075] While the mobile robot 1 is moving, the contact portion 221 of the second support portion 220 is retracted upward by the linear motion portion 222 and separated from the ground surface. In this state, the mobile robot 1 supports its own weight only by the first support portion 210.
[0076] When moving to the workbench 50, the stereo camera unit 111 installed on the head 110 of the dual-arm robot 10 measures the distance to the workbench 50, and the laser range finder 240 installed on the movement mechanism 20 measures the distance to the workbench 50.
[0077] Next, a support structure for the mobile robot 1 according to the first embodiment during movement will be described.
[0078] FIG. 5 is a schematic diagram for explaining a support structure of the mobile robot 1 according to the first embodiment during movement.
[0079] While the mobile robot 1 is moving, the contact portion 221 of the second support portion 220 is separated from the ground surface, and the weight W of the mobile robot 1 is supported only by the first support portion 210.
[0080] If the load (force) acting on the front first support portion 210F (wheel 212) is N10F and the load (force) acting on the rear first support portion 210R (wheel 212) is N10R, then W = N10R + N10F.
[0081] The magnitude of the biasing force of the first support portion 210 is adjusted so that when the wheel 212 rides up on a convex portion or falls into a concave portion, the elastic portion 213 expands and contracts to prevent the wheel 212 from moving away from the ground surface.
[0082] As a result, even when the mobile robot 1 moves over an uneven surface, it absorbs the impact it receives from the uneven surface, allowing the mobile robot 1 to move stably over the uneven surface and suppressing changes in the posture of the mobile robot 1 while it is moving.
[0083] Next, a state in which the mobile robot 1 described in the first embodiment moves to the work platform 50 and stops will be described.
[0084] FIG. 6 is an explanatory diagram illustrating a state in which the mobile robot 1 described in the first embodiment has moved to the work platform 50 and stopped.
[0085] The mobile robot 1 approaches the work platform 50 to a certain distance and then stops.
[0086] When approaching the work table 50, the stereo camera unit 111 installed on the head 110 of the dual-arm robot 10 measures the distance to the work table 50, and the laser range finder 240 installed on the movement mechanism 20 measures the distance to the work table 50.
[0087] The distance measurement by the stereo camera unit 111 and the laser range finder 240 is controlled by a control unit 30 installed in the mobile robot 1.
[0088] When the completion of movement is detected, the mobile robot 1 stops and brings the second support part 220 into contact with the ground surface. Then, in response to a signal transmitted from the control unit 30, the contact part 221 of the second support part 220 descends and contacts the ground surface, and the position and posture of the mobile robot 1 (particularly, the movement mechanism 20) are fixed.
[0089] Here, the position detection means of the stereo camera unit 111 or the laser range finder 240 may be used again to measure the distance to the workbench 50, and the self-position may be calculated using a previously prepared map or using a GPS, and then the deviation between the self-position and a preset operation position may be corrected. The calculation of the self-position is performed by the control unit 30.
[0090] Furthermore, when the detection of the self-position indicates that the stopping position is different from the planned position, the trajectory of the articulated arm 100 in various tasks to be performed thereafter can be corrected. Note that this trajectory correction is preferably performed in a state where the contact portion 221 of the second support portion 220 is in contact with the ground surface, in which the posture of the mobile robot 1 (particularly the moving mechanism 20) is stable.
[0091] Next, a support structure for the mobile robot 1 according to the first embodiment when it has moved to the work platform 50 and stopped will be described.
[0092] FIG. 7 is a schematic diagram illustrating a support structure in a state where the mobile robot 1 described in the first embodiment has moved to the work platform 50 and stopped.
[0093] When the mobile robot 1 stops and the contact portion 221 of the second support portion 220 comes into contact with the ground surface, the first support portion 210 and the second support portion 220 are parallel to each other and simultaneously support the weight of the mobile robot 1. Then, the second support portion 220 also supports part of the weight W of the mobile robot 1 that was supported only by the first support portion 210 during movement.
[0094] If the load (force) acting on the front first support portion 210F (wheel 212) is N11F, the load (force) acting on the rear first support portion 210R (wheel 212) is N11R, and the load (force) acting on the second support portion 220 (contact portion 221) is N21, then: W = N11R + N11F + N21. That is, when the double-arm robot 10 is in motion, the contact portion 221 of the second support portion 220 and the wheel 212 of the first support portion 210 come into contact with the ground surface.
[0095] In this way, the first support part 210 and the second support part 220 are arranged in parallel and simultaneously support the weight of the mobile robot 1, so that the posture of the mobile robot 1 (particularly the moving mechanism 20) can be stabilized.
[0096] Next, a description will be given of the transition over time of the load N11F acting on the first support 210 in front of the mobile robot 1 described in the embodiment 1 and the load N21 acting on the second support 220. Here, the operation of the second support when the robot is stopped will be described with reference to FIG.
[0097] FIG. 8 is a graph illustrating the time transition of the load N11F acting on the first support 210 and the load N21 acting on the second support 220 in the front of the mobile robot 1 described in the first embodiment.
[0098] In FIG. 8, the horizontal axis represents time and the vertical axis represents applied force (load), and the load N11F acting on the front first support portion 210F is shown as a representative.
[0099] After the mobile robot 1 stops and the contact portion 221 of the second support portion 220 comes into contact with the ground surface (t1), the load N11F acting on the front first support portion 210 gradually decreases and the load N21 acting on the second support portion 220 gradually increases, and after the rotation motor 2220 stops (t2), the first support portion 210 and the second support portion 220 are parallel to each other and simultaneously support the weight of the mobile robot 1.
[0100] In other words, when the load N21 acting on the second support portion 220 reaches a predetermined value, the load torque detection means detects that the load (current value) of the rotary motor 2220 has reached a set value or more, and stops the rotary motor 2220.
[0101] After the rotary motor 2220 stops, a load N21 acts on the second support portion 220, and a thrust force in the thrust direction is generated in the screw mechanism 2222 that engages with a nut portion formed on the moving body 223 that is connected to the contact portion 221. When a thrust force in the thrust direction is generated in the screw mechanism 2222, the screw mechanism 2222 tries to rotate in the rotation direction. For this reason, the worm gear 2221 is installed between the screw mechanism 2222 and the rotary motor 2220, and the worm gear 2221 suppresses reverse rotation of the rotary shaft of the rotary motor 2220. As a result, the reverse rotation of the rotary motor 2220 is suppressed, and the displacement of the second support portion 220 is also suppressed.
[0102] Here, the first support part 210 and the second support part 220 simultaneously support the weight of the mobile robot 1 means that none of the four wheels 212 separates from the ground surface. In other words, this means that all of the four wheels 212 remain in contact with the ground surface even after the contact part 221 comes into contact with the ground surface.
[0103] As a result, the load N11F acting on the front first support part 210 also supports part of the mobile robot 1's own weight, thereby reducing the load N21 acting on the second support part 220 and making the second support part 220 smaller.
[0104] At this time, the load N11F acting on the front first support portion 210 is smaller than the load N21 acting on the second support portion 220. This makes it possible to stabilize the posture of the mobile robot 1.
[0105] Next, a state in which the mobile robot 1 according to the first embodiment is working on the workbench 50 will be described.
[0106] FIG. 9 is an explanatory diagram for explaining a state in which the mobile robot 1 described in the first embodiment is working on a workbench 50. As shown in FIG.
[0107] The mobile robot 1 (mobile mechanism 20) approaches the work table 50 and stops. Then, the contact portion 221 of the second support portion 220 is maintained in contact with the ground surface.
[0108] In this state, the mobile robot 1 operates the actuator of the articulated arm 100 of the double-arm robot 10 to extend the articulated arm 100 to a predetermined position and grasps the test tube 501 or the pipette 502 with the hand 101. Then, dispensing and mixing operations are performed on the workbench 50.
[0109] In this state, the double-arm robot 10 may also be tilted forward relative to the moving mechanism 20. In other words, the double-arm robot 10 may also be tilted such that its waist 105 is tilted forward in the moving direction of the mobile robot 1 (the direction of arrow A in FIG. 9). This allows the double-arm robot 10 to improve the workability on the workbench 50.
[0110] When the hand 101 grasps the test tube 501 or the pipette 502, the stereo camera unit 111 can be used to measure the distance to the work table 50 and the distance to a target point on the work table 50, and the position and posture can also be corrected by observing the work object or the object marker.
[0111] Then, after completing all operations such as dispensing and mixing, the dual-arm robot 10 places the test tube 501 or pipette 502 that it is holding in a designated position, returns to its initial posture, moves the contact portion 221 of the second support portion 220 away from the ground surface, and returns to its initial position by the moving mechanism 20.
[0112] Furthermore, when work is to be carried out on a different workbench after all work has been completed or when the processed work object is to be transported to another location, the contact portion 221 of the second support portion 220 is again separated from the ground surface and moved by the moving mechanism 20.
[0113] Next, a support structure for the mobile robot 1 according to the first embodiment when the robot 1 is working on the workbench 50 will be described.
[0114] FIG. 10 is a schematic diagram illustrating a support structure when the mobile robot 1 according to the first embodiment is working on a workbench 50. As shown in FIG.
[0115] During operation of the mobile robot 1, the dual-arm robot 10 extends the articulated arm 100 in order to work on the workbench 50. In addition, in order to improve workability on the workbench 50, the dual-arm robot 10 may tilt its waist 105 forward.
[0116] As a result, the position of the center of gravity of the double-arm robot 10 placed on the mobile mechanism 20 changes in the direction of the arrow α in Fig. 10. Due to this change in the position of the center of gravity of the double-arm robot 10, a force moment M may act on the mobile robot 1 in a direction that tilts the entire robot forward.
[0117] If the load (force) acting on the front first support portion 210F (wheel 212) is N12F, the load (force) acting on the rear first support portion 210R (wheel 212) is N12R, and the load (force) acting on the second support portion 220 (contact portion 221) is N22, then: W = N12R + N12F + N22. That is, when the double-arm robot 10 is in motion, the contact portion 221 of the second support portion 220 and the wheel 212 of the first support portion 210 come into contact with the ground surface.
[0118] In this way, the first support portion 210 and the second support portion 220 are arranged in parallel and simultaneously support the weight of the mobile robot 1, so that the posture of the mobile robot 1 can be stabilized.
[0119] Furthermore, since the second support part 220 is installed in the forward movement direction of the mobile robot 1, the posture of the mobile robot 1 can be stabilized even if such a force moment M acts on the mobile robot 1.
[0120] In the mobile robot 1 described in the first embodiment, the installation position of the second support part 220 is further forward in the movement direction of the mobile robot 1 than the installation position of the first support part 210F (the direction of the arrow A in FIG. 10). In the mobile robot 1 described in the first embodiment, the second support part 220 is installed in the direction in which the articulated arm 100 of the double-arm robot 10 extends, and further outboard in the movement direction of the mobile robot 1 than the installation position of the first support part 210F. This makes it possible to stabilize the posture of the mobile robot 1 while the double-arm robot 10 is in operation.
[0121] During movement, the mobile robot 1 contracts the contact portion 221 of the second support portion 220 to separate the contact portion 221 from the ground surface, and during operation, the contact portion 221 of the second support portion 220 expands to bring the contact portion 221 into contact with the ground surface. This allows the elastic portion 213 of the first support portion 210 to absorb shocks from an uneven road surface during movement, and the second support portion 220 to stabilize the posture of the mobile robot 1 during operation.
[0122] In other words, during operation, the second support part 220 is in contact with the ground surface, and even if the articulated arm 100 moves in the working direction or the dual-arm robot 10 tilts in the working direction, it supports the weight of the mobile robot 1, stabilizes the posture of the mobile robot 1, and suppresses changes in the posture of the mobile robot 1.
[0123] Next, the time transition of the load N12F acting on the first support portion 210 and the load N22 acting on the second support portion 220 in the front of the mobile robot 1 described in the first embodiment will be described.
[0124] FIG. 11 is a graph illustrating the time transition of the load N12F acting on the first support 210 and the load N22 acting on the second support 220 in the front of the mobile robot 1 described in the first embodiment.
[0125] In FIG. 11, the horizontal axis indicates time, and the vertical axis indicates the applied force (load) and the center of gravity position, and the load N12F acting on the front first support portion 210F is shown as a representative.
[0126] 11, for example, the timing when the multi-joint arm 100 starts to extend and the position α of the center of gravity of the double-arm robot 10 starts to change is t3, the timing when the multi-joint arm 100 finishes extending and the change in the position α of the center of gravity of the double-arm robot 10 stops is t4, the timing when the multi-joint arm 100 starts to retract and the position α of the center of gravity of the double-arm robot 10 starts to change is t5, and the timing when the multi-joint arm 100 finishes retracting and the change in the position α of the center of gravity of the double-arm robot 10 stops is t6. In this manner, the position α of the center of gravity of the double-arm robot 10 changes.
[0127] On the other hand, as the center of gravity position α of the double-arm robot 10 changes, the load N22 acting on the second support unit 220 also changes as shown in Fig. 11. However, the load N12F acting on the front first support unit 210F is almost constant. In other words, the change in load caused by the change in center of gravity position α of the double-arm robot 10 is absorbed by the second support unit 220. This makes it possible to stabilize the posture of the mobile robot 1.
[0128] In this way, the force moment M generated by the change in the center of gravity position α of the double-arm robot 10 can be supported by the second support part 220. And, the load N12F acting on the front first support part 210F becomes almost constant, and the displacement of the front first support part 210F can be suppressed.
[0129] In addition, a load N22 acts on the second support portion 220, and a thrust force in the thrust direction is generated in the screw mechanism 2222 that engages with a nut portion formed on the moving body 223 that is connected to the contact portion 221. When a thrust force in the thrust direction is generated in the screw mechanism 2222, the screw mechanism 2222 tries to rotate in the rotation direction. For this reason, a worm gear 2221 is installed between the screw mechanism 2222 and the rotary motor 2220, and the worm gear 2221 suppresses reverse rotation of the rotary shaft of the rotary motor 2220. As a result, the rotary motor 2220 is suppressed from rotating in the reverse direction, and the displacement of the second support portion 220 is also suppressed. EXAMPLES
[0130] Next, the structure of the moving mechanism 20 of the mobile robot 1 according to the second embodiment will be described.
[0131] Fig. 12 is an explanatory diagram for explaining the structure of the moving mechanism 20 of the mobile robot 1 described in Example 2. Note that Fig. 12 illustrates the moving mechanism 20 of the mobile robot 1 with the cover removed so that the internal structure can be seen, in order to make it easier to understand.
[0132] The moving mechanism 20 described in the second embodiment is different from the moving mechanism 20 described in the first embodiment in that the second support parts 220 are disposed between the two front wheels 212 and in front of the central axis of the two front wheels 212, and between the two rear wheels 212 and behind the central axis of the two rear wheels 212. Thus, in the second embodiment, one second support part 220 is disposed forward and outward (at a position closer to the outer periphery) from the installation position of the front first support part 210, and one second support part is disposed rearward and outward (at a position closer to the outer periphery) from the installation position of the rear first support part 210, with respect to the forward and backward movement direction of the double-arm robot 10 (the direction of the arrow A in FIG. 12 and the direction of the arrow B in FIG. 12).
[0133] As a result, even when the multi-joint arm 100 is extended and operated in the forward / backward direction, the weight of the mobile robot 1 can be supported, the posture of the mobile robot 1 can be stabilized, and tilting of the body 250 can be suppressed. EXAMPLES
[0134] Next, the structure of the moving mechanism 20 of the mobile robot 1 according to the third embodiment will be described.
[0135] Fig. 13 is an explanatory diagram for explaining the structure of the moving mechanism 20 of the mobile robot 1 described in Example 3. In Fig. 13, the cover of the moving mechanism 20 of the mobile robot 1 is removed so that the internal structure can be seen, in order to make it easier to understand.
[0136] The moving mechanism 20 according to the third embodiment is different from the moving mechanism 20 according to the first embodiment in the installation position of the second support portion 220 and the general configuration of the second support portion 220.
[0137] In the moving mechanism 20 described in Example 3, the second support part 220 is installed at two locations, one on the left and one on the right, of the top surface (the top surface of the L-shaped side on which the central axis of the wheel 212 is installed) of the oscillating part 211 on the side of the mounting position of the dual-arm robot 10 (installation position in the direction of arrow A in Figure 13: installation position of the dual-arm robot 10) of the first support part 210 installed at four locations on the front, back, left and right of the moving mechanism 20.
[0138] In particular, the second support part 220 is installed behind the central axes of the two front wheels 212 of the first support part 210 in the movement direction of the mobile robot 1 and ahead of the swing axes 211s of the two front swing parts 211 of the first support part 210 (and the two front elastic parts 213 of the first support part 210) in the movement direction of the mobile robot 1. In other words, the second support part 220 is installed at two locations, left and right, between the central axis of the wheels 212 and the swing axis 211s of the swing part 211.
[0139] In this manner, in the third embodiment, the two second support parts 220 are installed further forward and outward than the installation positions of the oscillation shafts 211s of the two front oscillation parts 211 of the first support part 210 with respect to the moving direction of the double-arm robot 10. This makes it possible to stabilize the posture of the mobile robot 1.
[0140] Next, the vicinity of the second support portion 220 of the mobile robot 1 described in the third embodiment will be explained in an enlarged manner.
[0141] FIG. 14 is an explanatory diagram for explaining an enlarged view of the vicinity of the second support part 220 of the mobile robot 1 described in the third embodiment.
[0142] The second support portion 220 has a linear motion portion 222, a contact portion 221 on which a nut portion is formed and which is fixed to the swinging portion 211, and a frame 225 which holds these.
[0143] Furthermore, the linear motion unit 222 has a rotary motor 2220, a worm gear 2221, and a screw mechanism 2222. In the linear motion unit 222, the rotary shaft of the rotary motor 2220 rotates, and the rotational force is transmitted to the screw mechanism 2222 via the worm gear 2221, causing the screw mechanism 2222 to rotate. As the screw mechanism 2222 rotates, the contact unit 221 moves in the vertical direction. As the contact unit 221 moves downward, a load is applied to the swinging unit 211, and the posture of the mobile robot 1 can be stabilized.
[0144] It should be noted that the present invention is not limited to the above-described embodiment, but includes various modified examples. For example, the above-described embodiment is specifically described in order to easily explain the present invention, and the present invention is not necessarily limited to the embodiment having all of the described configurations.
[0145] Also, a part of the configuration of one embodiment can be replaced with a part of the configuration of another embodiment. Also, the configuration of another embodiment can be added to the configuration of one embodiment. Also, a part of the configuration of each embodiment can be deleted, and a part of another configuration can be added or replaced with a part of another configuration.
[0146] The accompanying drawings show examples according to the principles of the present invention, and are for understanding the present invention and are not to be used to interpret the present invention in a restrictive manner. The description in the specification is merely a typical example and does not limit the interpretation of the claims in any sense. [Explanation of symbols]
[0147] 1...mobile robot, 10...dual-arm robot, 100...multi-joint arm, 101...hand, 105...waist, 110...head, 111...stereo camera unit, 20...movement mechanism, 210...first support part, 211...oscillating part, 211s...oscillating shaft, 212...wheel, 213...elastic part, 220...second support part, 221...contact part, 222...linear part, 2220...rotary motor, 2221...worm gear, 2222...screw mechanism, 223...moving body, 224...photointerrupter, 225...frame, 226...fixing member, 227...spherical bearing, 230...bumper, 240...laser range finder, 250...car body, 30...control part, 50...workbench, 501...test tube, 502...pipette.
Claims
1. A mobile robot having a working mechanism having an articulated arm and a moving mechanism for moving the working mechanism, the mobile robot transporting a liquid and performing dispensing and mixing operations, the working mechanism is installed at a position offset forward with respect to a moving direction of the moving mechanism, and is installed so as to be inclined forward with respect to the moving mechanism in the moving direction of the moving mechanism during operation of the working mechanism, the moving mechanism has a first support portion and a second support portion that support its own weight, The first support portion has four swinging portions (front, rear, left, and right) that swing around a swing axis, four wheels (front, rear, left, and right) that are installed on the swinging portions, and four elastic portions (front, rear, left, and right) that constantly apply a biasing force that brings the wheels into contact with a ground surface, the second support part is installed between the two front wheels at a position closer to the outer periphery in the direction of movement of the moving mechanism than the central axis of the two front wheels, the second support part having a moving body that moves up and down by a linear actuator, and a contact part that is installed on the moving body and comes into contact with the ground surface when extended and moves away from the ground surface when contracted.
2. 2. The mobile robot according to claim 1, A mobile robot, characterized in that the linear actuator and the contact portion of the second support portion have higher rigidity than the elastic portion of the first support portion.
3. 2. The mobile robot according to claim 1, A mobile robot, characterized in that, when the working mechanism is in operation, the contact portion of the second support portion and the wheel of the first support portion come into contact with a ground surface.
4. 2. The mobile robot according to claim 1, The linear actuator is a mobile robot characterized in having a rotary motor, a linear motion unit in which the rotary motor's rotary shaft rotates and the rotational force is transmitted via a worm gear to a screw mechanism to rotate the screw mechanism, and a moving body that is moved up and down by the linear motion unit.
5. 2. The mobile robot according to claim 1, The mobile robot is further characterized in that the second support portion is installed between the two rear wheels at a position closer to the outer periphery than the central axis of the two rear wheels.
6. 2. The mobile robot according to claim 1, A mobile robot, wherein the working mechanism and the moving mechanism each have a position detection means for measuring a distance.
7. A mobile robot having a working mechanism having an articulated arm and a moving mechanism for moving the working mechanism, the mobile robot transporting a liquid and performing dispensing and mixing operations, the working mechanism is installed at a position offset forward with respect to a moving direction of the moving mechanism, and is installed so as to be inclined forward with respect to the moving mechanism in the moving direction of the moving mechanism during operation of the working mechanism, the moving mechanism has a first support portion and a second support portion that support its own weight, The first support portion has four swinging portions (front, rear, left, and right) that swing around a swing axis, four wheels (front, rear, left, and right) that are installed on the swinging portions, and four elastic portions (front, rear, left, and right) that constantly apply a biasing force that brings the wheels into contact with a ground surface, The second support portion includes a linear motion portion in which a rotation shaft of a rotary motor rotates, and the rotation force is transmitted to a screw mechanism via a worm gear to rotate the screw mechanism, and a contact portion that moves up and down by the linear motion portion, the second support part is installed at two locations, one on the left and one on the right, between the central axes of the two front wheels and the swing axes of the two front swing parts, in the movement direction of the moving mechanism, and a load is applied to the swing parts by moving the contact part downward.
Citation Information
Patent Citations
Compound trussed movable overload casting robot
CN107253179A
Automatic painting mount apparatus of bridge
JP1986122315A
Method of hume-pipe burying construction by propulsive excavation, and self-advancing device for automatic survey used in the construction
JP1995011876A
Slide form moving device
JP1995331872A
Automatic guided vehicle for factory use
JP1996168978A
