This application is based upon and claims the benefit of priority from Japanese Patent Application No. 2022-4662, filed on Jan. 14, 2022; the entire contents of which are incorporated herein by reference.
Embodiments described herein relate generally to a mobile robot system.
In known technology of a mobile robot in which a handling robot is mounted to an unmanned vehicle, the mobile robot uses a sensor to read an image of two marks provided at different corner portions of a workpiece, detects a workpiece position based on the two mark positions that are read, uses the detected workpiece position to perform a position correction, and subsequently performs a handling task of a workpiece.
In one type of mobile robot, an arm that transfers a workpiece on a stand is mounted to the mobile robot. This type of mobile robot transfers the workpiece by being automatically positioned at the stand vicinity, but there are cases where the stop position of the mobile robot fluctuates. It is therefore difficult to position the arm accurately with respect to the workpiece using only teaching position information.
Furthermore, as the workpiece size increases, the length of the arm performing a task on the workpiece also must be long, and it is more difficult to accurately position the arm with respect to the workpiece. This is because the effects of the orientation control of the mobile robot are greatly reflected in the positional misalignment of the arm. Accordingly, highly-accurate orientation control is necessary. Because it is necessary to correct the misalignment amount in the three axes of an X-axis, a Y-axis, and a O-axis, it is necessary for the mobile robot to include a multi-axis arm. In such a case, it is necessary to increase the accuracy of the control of the multi-axis arm, and to accurately position the arm with respect to the workpiece. Thus, the cost of manufacturing a mobile robot system has been high because it is difficult to accurately position the arm of the mobile robot with respect to the workpiece placed on the stand.
According to an embodiment, a mobile robot system includes a placement platform, and a mobile robot configured to transfer a workpiece placed at a prescribed position of the placement platform. The placement platform includes a guide including an opening part having an opening greater than a prescribed width, and a body part having the prescribed width. The mobile robot includes an arm part configured to transfer the workpiece placed at the prescribed position of the placement platform, two or more rotatable rollers that have mutually-parallel rotation axes and are arranged along one straight line along a direction crossing an extension direction of the rotation axes, a moving part that is movable omni-directionally, and a controller configured to drive a drive part to move the mobile robot so that at least two rollers among the two or more rollers are received inside the body part of the guide. The guide is positioned so that the arm part can transfer the workpiece placed at the prescribed position of the placement platform when the at least two rollers are received in the body part.
Embodiments of the invention will now be described with reference to the drawings.
The drawings are schematic or conceptual; and the relationships between the thickness and width of portions, the proportions of sizes among portions, etc., are not necessarily the same as the actual values. The dimensions and proportions may be illustrated differently among drawings, even when the same portion is illustrated.
The configuration that allows the mobile robot 20 to move omni-directionally will now be described. According to the embodiment, the mobile robot 20 is movable omni-directionally by arranging mecanum wheels as the drive part at four corners at the lower side of the mobile robot main body 30.
Returning now to
The electric Z-axis 42 is mounted to another surface formed of the arm part posts 41 and the rod-shaped members 41a. The cross section of the electric Z-axis 42 has a rectangular rod shape. The arm part 44 is mounted to the electric Z-axis 42. The electric Z-axis 42 includes a motor (not illustrated); and the arm part 44 can be moved in the Z-axis direction along the electric Z-axis 42 by rotationally driving the motor. According to the embodiment, the Z-axis guides 43 extend along the Z-axis. As a result, the movement of the arm part 44 can be guided when the arm part 44 operates along the electric Z-axis 42 in the Z-axis direction.
The arm part 44 includes an arm part supporter 45, a first arm 46a, and a second arm 46b. The arm part supporter 45 is mounted to the electric Z-axis 42. The first arm 46a is mounted to one end of the arm part supporter 45; and the second arm 46b is mounted to the other end of the arm part supporter 45. The arm part supporter 45, the first arm 46a, and the second arm 46b may be formed as one piece. The spacing between the first arm 46a and the second arm 46b is defined based on the width in the Y-axis direction of the workpiece W to be transferred. The first arm 46a and the second arm 46b each are configured to extend from the arm part supporter 45 to be parallel to the installation surface on which the mobile robot system 1 is disposed.
The first unit U1 and the second unit U2 extend a prescribed length along the installation surface at two ends of the arm part post 41 at the lower side. The first unit U1 and the second unit U2 are configured so that the mobile robot 20 does not lose balance when the arm part 44 transfers the workpiece W. Wheels are located at the lower sides of the distal ends of the first and second units U1 and U2. According to the embodiment, the wheels are omniwheels.
The roller base 47 is located at the first unit U1. The roller base 47 is a plate-like member. According to the embodiment, the roller base 47 is located at the second unit U2 side of the first unit U1 and extends along the longitudinal direction of the first unit U1. At least two passively rotatable guide rollers are arranged at the roller base 47 so that the centers of the guide rollers are along one straight line along the longitudinal direction. According to the embodiment as shown in
The contact sensor 49 and the laser rangefinder 50 are located at the lower side of the arm part post 41 between the first unit U1 and the second unit U2. The contact sensor 49 detects contact with the stand 10. When the contact with the stand 10 is detected, the driving of the mobile robot main body 30 is stopped. The laser rangefinder 50 irradiates laser pulses in multiple directions, and performs processing such as receiving the reflected waves of the laser pulses, etc. The two stoppers 51 are located respectively at the lower sides of the arm part posts 41. The stoppers 51 regulate the stop position of the mobile robot 20 with respect to the stand 10. The contact sensor 49 is configured to detect the contact with the stand 10 when the mobile robot 20 is positioned at the stop position.
The controller 110 includes a CPU, ROM, RAM, etc., and controls the transfer processing of the workpiece by the mobile robot 20. The storage part 120 is, for example, a hard disk drive (HDD) or a solid state drive (SSD), and stores various data and/or programs. According to the embodiment, a 2D map that indicates the workspace in which the stand 10 is installed and the structure of the stand 10 (the number of placement platform levels, the positions at which the workpieces W are placed, the mark positions, etc.) are stored as the various data. The programs that are stored include programs related to transfer processing of the workpieces W such as, for example, a program for executing processing when transferring the workpiece W from the prescribed position of the stand 10 to the prescribed position of another stand 10.
The communication part 130 is a wireless communication part, and receives instructions from the outside. For example, the mobile robot 20 starts performing the transfer processing of the workpiece W based on an instruction received via the communication part 130.
The drive controller 140 individually controls the driving of the mecanum wheels 31 described above. As described above, the mecanum wheels 31 are located at the lower side of the four corners of the mobile robot main body 30; and the mecanum wheels 31 are configured to be independently drivable respectively by the first to fourth drive controllers 141 to 144. Accordingly, the mobile robot 20 is movable omni-directionally under the control of the controller 110.
The arm drive controller 150 moves the arm part 44 along the electric Z-axis 42 to a prescribed position in the Z-axis direction by driving a motor (not illustrated) included in the electric Z-axis 42. The contact sensor 49 detects contact with the stand 10. The detection result is transmitted to the controller 110. The laser rangefinder 50 irradiates a laser in pulses in multiple directions, and measures the distance to an object and the two-dimensional shape based on the time to receive the reflected wave. Based on the measurement result thus obtained, the laser rangefinder 50 estimates the position of the mobile robot 20 on the 2D map. The estimation that is based on the measurement result also includes the positions of the marks 13a and 14a of the positioning members 13 and 14. The estimation result is transmitted to the controller 110 as position information.
The processing that is performed by the mobile robot system 1 will now be described with reference to
The mobile robot 20 is positioned at the target position with respect to the stand 10. The movement to the target position is realized by the controller 110 executing a program related to the transfer. The mecanum wheels 31 are driven by the drive controller 140 of the mobile robot main body 30; and the mobile robot 20 is positioned at the target position according to a predetermined path. At this time, the mobile robot 20 is driven by the mecanum wheels 31; therefore, a following motion occurs easily due to the small contact point with the installation surface. Accordingly, when the mobile robot 20 has stopped at the target position, there are cases where positional and orientation misalignment with respect to the target position occur.
After the mobile robot 20 has stopped at the target position, the controller 110 receives estimated position information from the laser rangefinder 50 (ST101).
Then, the controller 110 determines whether or not the current position of the mobile robot 20 is the target position (ST102). According to the embodiment, the controller 110 determines whether or not the estimated position information of the mobile robot 20 and the predesignated position information on the 2D map match by comparing the two positions. As a result, the controller 110 can confirm whether or not the current position is the target position.
When the position is determined to be the target position (ST102: YES), the controller 110 determines whether or not the orientation of the mobile robot 20 is correct (ST103). According to the embodiment, it is determined whether or not the orientation of the mobile robot 20 is in a direction (the Y-axis direction) perpendicular to the longitudinal direction of the stand 10. More specifically, the controller 110 performs the determination based on the estimated position of the mark 13a received from the laser rangefinder 50. As a result, the orientation of the mobile robot 20 can be confirmed to be accurate. Although a configuration that uses the laser rangefinder 50 to determine the target position and the orientation is described in the embodiment, the sensor is not limited thereto. For example, a separate sensor for determining the target position and the orientation may be included in the mobile robot 20; and the target position and the orientation may be determined using the detection result of this sensor.
When the controller 110 determines that the positions do not match (ST102: NO), or determines that the orientations do not match (ST103: NO), the controller 110 corrects the misalignment of the mobile robot 20 (ST104). More specifically, the controller 110 controls the drive part controller 140 to correct the positional and orientation misalignments to the target position and orientation. As a result, the mobile robot 20 is positioned at the target position; and the orientation of the mobile robot 20 is corrected. As a result, for example, the arrangement direction of the guide rollers R1 to R6 is positioned to be included within the range of the opening of the guide 11 located at the stand 10.
When the mobile robot 20 is determined to be accurately positioned at the target position (ST103: YES), or when the misalignment has been corrected (ST104), the controller 110 controls the arm drive controller 150 to move the arm part 44 to the prescribed position in the Z-axis direction matching the height at which the workpiece W is to be placed (ST105). To pick up the workpiece W placed on the placement platform 10a of the first level of the stand 10, the arm part 44 is moved to a height such that the oblique side portions of the workpiece guides WG of the first arm 46a and the oblique side portions of the workpiece guides WG of the second arm 46b are positioned at the lower sides of the protrusions of the workpiece W. Then, the controller 110 drives the drive part (the four mecanum wheels 31) (ST106). Specifically, the controller 110 causes the mobile robot 20 to travel toward the stand 10.
As a result, the mobile robot 20 approaches the side surface of the stand 10. At this time, even if the mobile robot 20 has positional misalignment and/or tilt with respect to the stand 10, as long as the guide roller R1 is positioned within the range of the width D2, the guide roller R1 at the distal end of the roller base 47 abuts the inner side of the opening of the guide 11 as schematically shown in
Then, the controller 110 determines whether or not the mobile robot 20 has traveled to the prescribed position (ST107). According to the embodiment, the controller 110 determines whether or not the prescribed position has been reached based on a signal transmitted from the contact sensor 49. For example, it is determined that the prescribed position has not been reached when an OFF signal is received from the contact sensor 49; and it is determined that the prescribed position has been reached when an ON signal is received. Here, the prescribed position is a position at which the four workpiece guides WG of the arm part 44 match the protrusions of the workpiece W in the Z-axis direction. When it is determined that the prescribed position has not been reached (ST107: NO), the controller 110 continues the travel operation of the mobile robot 20.
When it is determined that the prescribed position has been reached (ST107: YES), the controller 110 stops the driving of the drive part (ST108). As a result, the mobile robot 20 stops. At this time, the mobile robot 20 is accurately positioned with respect to the stand 10 because the centers of the multiple guide rollers R1 to R6 are arranged along one straight line. In other words, two workpiece guides WG of the first arm 46a are positioned at the lower side of the protruding part and at the right side of the workpiece W when viewed from the mobile robot 20; and two workpiece guides WG of the second arm 46b are positioned at the lower side of the protruding part and at the left side of the workpiece W when viewed from the mobile robot 20.
Then, the controller 110 controls the arm drive controller 150 to move the arm part 44 upward in (the Z-axis direction) (ST109). The movement amount of the arm part 44 at this time is at least an amount that lifts the workpiece W from the placement platform 10a. As a result, the workpiece W is picked up from the placement platform 10a. Then, the mobile robot 20 drives the drive part (ST110). Specifically, the controller 110 moves the mobile robot 20 out of the stand 10, and then moves the mobile robot 20 from the current position to the target position at the next stand 10 on which the workpiece W that was picked up is to be placed. Thereafter, the processing is similar to the processing of steps ST101 to ST110 described above, in which the workpiece W is placed instead of being picked up.
In the mobile robot system 1 having such a configuration, the guide 11 or the guide 12 of the stand 10 is positioned so that the arm part 44 can transfer the workpieces W placed on the placement platforms 10a, 10b, and 10c of the stand 10 when the guide rollers R1 to R6 are received in the body part 11b of the guide 11 or a body part 12b of the guide 12. Accordingly, in the mobile robot system 1, the arm part 44 of the mobile robot 20 can be accurately positioned with respect to the workpiece W placed on the stand 10 by using a simple configuration; and the cost for positioning can be reduced. If the tool part 40 were to include a multi-axis robot arm to correct the misalignment in the three axes of the X-axis direction, the Y-axis direction, and the Θ-direction, the mobile robot system 1 would be expensive; however, according to the embodiment, the misalignment of the three axes can be prevented because the positioning can be performed accurately; therefore, a multi-axis robot arm may not be included.
In the mobile robot system 1, the mecanum wheels 31 are used as the drive part of the mobile robot 20 when the mobile robot 20 travels, for example, along the inner side of the opening of the guide 11; therefore, the contact with the installation surface is reduced, and the travel is smooth and regulated.
Although an example is described in the embodiment above in which six of the guide rollers R1 to R6 are located at the roller base 47, the number of guide rollers is not limited to six; it is sufficient for the configuration to include two or more guide rollers, and for the centers of the two or more guide rollers to be arranged along one straight line. When only two guide rollers are included, it is desirable for the distance between the guide rollers to be defined so that, for example, when the two guide rollers are received in the body part 11b, the guide rollers are positioned at the two end portions of the body part 11b. Thus, by increasing the distance between the guide rollers, the positioning accuracy of the arm part 44 with respect to the workpiece W placed on the stand 10 can be increased even when two guide rollers are provided.
A second embodiment differs from the first embodiment in that a control is performed to adjust the travel direction of the mobile robot inside the guide as the guide rollers travel inside the guide. Accordingly, the control will now be described in detail. The same configurations as those of the first embodiment are marked with the same reference numerals; and a description of these configurations is omitted. To simplify the description in the embodiment, an example is described in which one guide 11 is included in the stand 10; and two guide rollers are included in the unit U1.
Then, the controller 110 drives the drive part (the four mecanum wheels 31) (ST202). As a result, the controller 110 continues the processing of moving the mobile robot 20 in the travel direction at a movement velocity Vx. As the mobile robot 20 travels, the controller 110 receives the outputs from the two two-axis force sensors 161 and 162 (ST203).
Then, the controller 110 calculates the Y-axis direction force component based on the received output, and sets the drive velocity of the drive part to include the movement velocity Vx in the X-axis direction and a velocity component calculated to move away from where the Y-axis direction force component is applied (ST204). For example, when the mobile robot 20 is traveling in the X-axis direction as illustrated by arrow A1 in the schematic view of
Then, the controller 110 determines whether or not the contact sensor 49 has detected the stand 10 (ST205). When the controller 110 determines that the contact sensor 49 has not detected the stand 10 (ST205: NO), the controller 110 performs the processing of steps ST203 and ST204 described above. As a result, the adjustment processing of the travel direction is continued until the contact sensor 49 detects the stand 10, that is, while the mobile robot 20 moves in the travel direction. On the other hand, when the contact sensor 49 is determined to have detected the stand 10 (ST205: YES), the controller 110 stops the driving of the drive part (ST206).
According to the second embodiment, the orientation of the travel of the mobile robot 20 can be adjusted as the guide rollers R1 and R2 of the mobile robot 20 travel through the guide 11. Because the mobile robot 20 uses the mecanum wheel 31, as described above, the contact point with the installation surface of the stand 10 is the contact point C1 and is small, and a following motion may occur due to slippage. According to the embodiment, the travel direction is adjusted to travel straight in the travel direction inside the guide 11, and so the operation amount of the mobile robot 20 due to the following motion can be reduced. As a result, the time that friction is generated by the mecanum wheels 31 with the installation surface can be reduced, and the life of the mecanum wheels 31 can be improved.
A third embodiment differs from the first embodiment in that the size of the opening of the guide is defined. Accordingly, matters related to the size of the opening of the guide will now be described in detail. The same configurations as those of the first embodiment are marked with the same reference numerals; and a description of these configurations is omitted. To simplify the description of the embodiment, similarly to the second embodiment, an example is described in which the stand 10 includes one guide 11; and two guide rollers are located at the unit U1.
The mobile robot 20 estimates the position on the 2D map based on the calculation result from the laser rangefinder 50, and moves from the prescribed position to the target position. When being positioned at the target position, as described above, there are cases where the mobile robot 20 cannot accurately stop at the target position. Thus, there are cases where misalignment of the mobile robot 20 occurs when stopping; therefore, according to the embodiment, the width D2 of the opening of the guide 11 is set to a width that accounts for the error due to the misalignment as much as possible. Specifically, it is sufficient for the width D2 to be determined based on the positioning accuracy of the mobile robot 20 at the target position, the friction force of the mecanum wheels 31 with the installation surface, the weight of the workpiece W placed on the arm part 44, etc.
Even when, for example, orientation misalignment in the lateral direction occurs when the mobile robot 20 stops at the target position as illustrated by the two arrows A4 of
According to the third embodiment, the opening of the guide 11 is set to have the width D2 so that the mobile robot system 1 can account for misalignment when the mobile robot 20 stops at the target position. It is therefore unnecessary to perform correction processing of the misalignment when stopping the mobile robot 20. Accordingly, for example, the adjustment processing of the misalignment when positioned at the target position according to the first embodiment (steps ST102 to ST104) can be omitted, and the transfer processing of the workpiece W by the mobile robot system 1 can be quick.
Although a configuration is described in embodiments above in which the guide rollers R1 to R6 are located at the roller base 47, the configuration is not limited thereto. For example, the guide rollers R1 to R6 may be located directly at the unit U1. The roller base 47 may be located at the unit U2 even when not located at the unit U1. Furthermore, the settings of the guide 11, the guide 12, and the guide rollers R1 to R6 are arbitrary as long as the arm part 44 can be positioned so that the workpiece W can be transferred when the guide rollers R1 to R6 are received in the body parts 11b and 12b of the guides 11 and 12.
While certain embodiments have been described, these embodiments have been presented by way of example only, and are not intended to limit the scope of the inventions. Indeed, the novel embodiments described herein may be embodied in a variety of other forms; furthermore, various omissions, substitutions, and changes in the form of the embodiments herein may be made without departing from the spirit of the inventions. The accompanying claims and their equivalents are intended to cover such forms or modifications as would fall within the scope and spirit of the inventions.
Number | Date | Country | Kind |
---|---|---|---|
2022-004662 | Jan 2022 | JP | national |
Number | Date | Country | |
---|---|---|---|
Parent | PCT/JP2023/000791 | Jan 2023 | WO |
Child | 18771495 | US |