WO2022123762A1 - 自走装置 - Google Patents

自走装置 Download PDF

Info

Publication number
WO2022123762A1
WO2022123762A1 PCT/JP2020/046229 JP2020046229W WO2022123762A1 WO 2022123762 A1 WO2022123762 A1 WO 2022123762A1 JP 2020046229 W JP2020046229 W JP 2020046229W WO 2022123762 A1 WO2022123762 A1 WO 2022123762A1
Authority
WO
WIPO (PCT)
Prior art keywords
self
propelled device
laser sensor
wheel
laser
Prior art date
Application number
PCT/JP2020/046229
Other languages
English (en)
French (fr)
Inventor
秀樹 長末
亮太 前田
Original Assignee
Dmg森精機株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Dmg森精機株式会社 filed Critical Dmg森精機株式会社
Priority to US18/266,154 priority Critical patent/US20240094738A1/en
Priority to CN202080107776.7A priority patent/CN116615698A/zh
Priority to JP2022534793A priority patent/JP7266757B2/ja
Priority to EP20965144.7A priority patent/EP4250043A1/en
Priority to PCT/JP2020/046229 priority patent/WO2022123762A1/ja
Publication of WO2022123762A1 publication Critical patent/WO2022123762A1/ja

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
    • B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60G—VEHICLE SUSPENSION ARRANGEMENTS
    • B60G3/00—Resilient suspensions for a single wheel
    • B60G3/02—Resilient suspensions for a single wheel with a single pivoted arm
    • B60G3/12—Resilient suspensions for a single wheel with a single pivoted arm the arm being essentially parallel to the longitudinal axis of the vehicle
    • B60G3/14—Resilient suspensions for a single wheel with a single pivoted arm the arm being essentially parallel to the longitudinal axis of the vehicle the arm being rigid
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D61/00—Motor vehicles or trailers, characterised by the arrangement or number of wheels, not otherwise provided for, e.g. four wheels in diamond pattern
    • B62D61/10—Motor vehicles or trailers, characterised by the arrangement or number of wheels, not otherwise provided for, e.g. four wheels in diamond pattern with more than four wheels
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06—Systems determining position data of a target
    • G01S17/42—Simultaneous measurement of distance and other co-ordinates
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/87—Combinations of systems using electromagnetic waves other than radio waves
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88—Lidar systems specially adapted for specific applications
    • G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/20—Control system inputs
    • G05D1/24—Arrangements for determining position or orientation
    • G05D1/242—Means based on the reflection of waves generated by the vehicle
    • G05D1/2424—Means based on the reflection of waves generated by the vehicle for monitoring a plurality of zones
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/60—Intended control result
    • G05D1/617—Safety or protection, e.g. defining protection zones around obstacles or avoiding hazards
    • G05D1/622—Obstacle avoidance
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60B—VEHICLE WHEELS; CASTORS; AXLES FOR WHEELS OR CASTORS; INCREASING WHEEL ADHESION
    • B60B19/00—Wheels not otherwise provided for or having characteristics specified in one of the subgroups of this group
    • B60B19/003—Multidirectional wheels
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2105/00—Specific applications of the controlled vehicles
    • G05D2105/45—Specific applications of the controlled vehicles for manufacturing, maintenance or repairing
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2107/00—Specific environments of the controlled vehicles
    • G05D2107/70—Industrial sites, e.g. warehouses or factories
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2109/00—Types of controlled vehicles
    • G05D2109/10—Land vehicles
    • G05D2109/18—Holonomic vehicles, e.g. with omni wheels
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2111/00—Details of signals used for control of position, course, altitude or attitude of land, water, air or space vehicles
    • G05D2111/10—Optical signals
    • G05D2111/17—Coherent light, e.g. laser signals

Definitions

  • This disclosure relates to a wheel-driven self-propelled device.
  • Unmanned production systems such as factories are desired.
  • Self-propelled devices are being developed to achieve unmanned operation.
  • the self-propelled device transports the workpieces and tools before machining to each machine tool, and collects the workpieces and used tools that have been machined by each machine tool.
  • Patent Document 1 discloses a self-propelled device for the purpose of "creating map information well".
  • the self-propelled device is a distance measuring device that rotationally drives a light projecting unit that emits projected light and outputs distance measurement data based on the light received by the reflected light reflected by the object to be measured, and a distance measuring device based on the distance measurement data. It is equipped with a map creation unit that creates map information and an obstacle sensor that detects obstacles.
  • the running of the self-propelled device needs to be controlled so as to avoid obstacles.
  • An example of such an obstacle is an obstacle at a low position.
  • the obstacle sensor is provided directly under the top plate portion, it is not possible to detect an obstacle at a low position.
  • the wheels of the self-propelled device are configured to move up and down in order to absorb the impact during running. If the laser sensor is provided on the upper part of such a wheel, the laser sensor must be provided on the upper part of the range of vertical movement of the wheel. In this case, the self-propelled device cannot detect the obstacle at a low position. Therefore, it is desired to detect an obstacle at a low position even in a self-propelled device equipped with wheels that can move up and down.
  • the self-propelled device includes a wheel-driven traveling body.
  • the traveling main body includes a first wheel portion and a second wheel portion provided on the traveling main body at predetermined intervals along the traveling direction of the self-propelled device.
  • the second wheel portion has a pair of wheels configured to be movable up and down with respect to the self-propelled device.
  • the self-propelled device further includes a first laser sensor. The first laser sensor irradiates the laser beam while rotating it around the first laser sensor, and receives the reflected light of the laser beam to detect an object around the first laser sensor.
  • the scanning surface is provided on the traveling body so as to exclude the upper part of the pair of wheels, and the scanning surface within the range through which the laser light passes during the rotation of the laser light is above and below the pair of wheels.
  • the traveling body is provided so as to be lower than the highest reaching point of the moving range.
  • the first laser sensor is provided between the pair of wheels in the top view of the traveling body.
  • the first wheel portion has a first front wheel and a second front wheel.
  • the pair of wheels are a first rear wheel and a second rear wheel.
  • the self-propelled device further includes a second laser sensor having the same function as the first laser sensor and a third laser sensor having the same function as the first laser sensor.
  • the second laser sensor is provided on the traveling body so as to be located above the first front wheel.
  • the third laser sensor is provided on the traveling body so as to be located above the second front wheel.
  • the direction of the laser beam emitted from the first laser sensor includes at least the backward direction of the self-propelled device.
  • the direction of the laser beam emitted from the second laser sensor includes at least the forward direction of the self-propelled device and one direction orthogonal to the forward direction.
  • the direction of the laser beam emitted from the third laser sensor includes at least the forward direction of the self-propelled device and the other direction orthogonal to the forward direction.
  • the height from the ground at the highest reaching point is 200 mm or more.
  • the height of the scanning surface from the ground is 200 mm or less.
  • configuring the pair of wheels so that they can move up and down includes configuring them so that they can swing in a plane orthogonal to the traveling direction of the self-propelled device 100.
  • the pair of wheels is an omni wheel.
  • FIG. 1 is a diagram showing the appearance of the self-propelled device 100.
  • the self-propelled device 100 transports an object to be transported such as a work or a tool to an arbitrary place.
  • the self-propelled device 100 includes a wheel-driven traveling body 10, a base 12, and an arm robot 13.
  • the base 12 is fixed to the upper part of the traveling body 10.
  • the base 12 has a cover 110.
  • a laser sensor 105 (see FIG. 2), which will be described later, is provided inside the cover 110.
  • the self-propelled device 100 controls the traveling of the traveling main body 10 such as the forward direction R, the reverse direction B, right turn, and left turn based on the detection result of the laser sensor 105.
  • the arm robot 13 is provided on the base 12. Further, a place for the work W is provided on the base 12. The arm robot 13 grips the work W and moves the work W to a designated place.
  • the device may be installed on the traveling body 10.
  • the transfer device may be a robot (for example, an autoloader) driven by 2 to 3 axes.
  • FIG. 2 is a diagram showing a laser sensor 105 and two-dimensional distance data D1 output from the laser sensor 105.
  • the laser sensor 105 is configured to irradiate the laser light LA while rotating it with the central axis AX of the laser sensor 105 as the center of rotation, and to receive the reflected light of the laser light LA.
  • the laser sensor 105 outputs the two-dimensional distance data D1 in which the distance to the surrounding object is represented by the angle with respect to the central axis AX.
  • the two-dimensional distance data D1 represents the distance to each object existing in the scanning surface SC by the irradiation angle.
  • the laser sensor 105 is composed of an irradiation unit, a mirror, and a light receiving unit.
  • the irradiation unit irradiates the mirror with a laser beam.
  • the mirror is made rotatable around the central axis AX by a motor (not shown), and reflects the laser beam LA in each direction.
  • the laser sensor 105 irradiates the laser beam LA in each direction.
  • the laser beam LA is reflected by the object and returns to the laser sensor 105.
  • the laser sensor 105 receives the reflected light at the light receiving unit.
  • the laser sensor 105 receives the reflected light from the object and calculates the distance to the object. As an example, the laser sensor 105 calculates the distance from the laser sensor 105 to an object based on the time from irradiating the laser beam LA to receiving the reflected light of the laser beam LA. Typically, the laser sensor 105 calculates the distance to an object by multiplying the speed of light by the time. The laser sensor 105 outputs the two-dimensional distance data D1 representing the distance for each angle with respect to the central axis AX by associating the distance with the irradiation angle of the laser beam LA.
  • the angle range of the distance data output by the laser sensor 105 is arbitrarily set. In the example of FIG. 2, the angle range of 0 degrees to 270 degrees is effectively set.
  • the laser sensor 105 detects an object around the laser sensor 105 by irradiating the laser sensor 105 while rotating the laser light LA and receiving the reflected light of the laser light LA. do.
  • FIG. 3 is a diagram showing an outline of the internal structure of the traveling main body 10.
  • FIG. 4 is a view showing a side view of the traveling main body 10.
  • FIG. 5 is a diagram showing the traveling main body 10 from the reverse direction B shown in FIG.
  • the traveling main body 10 includes a frame 11, a first wheel portion 15 that functions as a front wheel, and a second wheel portion 35 that functions as a rear wheel.
  • the frame 11 has a space appropriately cut out when viewed from a plane so that necessary structures can be arranged, and has a structure in which the inside is hollow in order to reduce the weight.
  • the first wheel portion 15 and the second wheel portion 35 are connected to the frame 11 at predetermined intervals along the traveling direction (direction of arrow R).
  • the traveling direction indicates a forward direction or a reverse direction of the self-propelled device 100.
  • the first wheel portion 15 includes a first left wheel portion 16 provided on the left side when viewed from the back surface of the self-propelled device 100, and a right front wheel portion 25 provided on the right side when viewed from the back surface of the self-propelled device 100. ..
  • the first left wheel portion 16 includes a first left support arm 17 provided on the left side surface of the frame 11, a left front wheel 19, and a left drive wheel 21.
  • the left front wheel 19 and the left drive wheel 21 are supported at both ends of the first left support arm 17 so as to be rotatable around horizontal rotation axes 20 and 22 orthogonal to the traveling direction of the self-propelled device 100.
  • the right front wheel portion 25 includes a first right support arm 26 provided on the right side surface of the frame 11, a right front wheel 28, and a right drive wheel 30.
  • the right front wheel 28 and the right drive wheel 30 are supported at both ends of the first right side support arm 26 so as to be rotatable around horizontal rotation axes 29 and 31 orthogonal to the traveling direction of the self-propelled device 100.
  • the first right side support arm 26 is supported by a support shaft 27 provided on the right side surface of the frame 11, and is in the vertical plane along the traveling direction of the self-propelled device 100 in the direction of arrow DE shown in FIG. It is possible to swing.
  • the first left side support arm 17 is supported by the support shaft 18 provided on the left side surface of the frame 11 and is in the same direction as the arrow DE direction in the vertical plane along the traveling direction of the self-propelled device 100. It can be swung.
  • the left front wheel 19 and the right front wheel 28 are driven wheels, and the left drive wheel 21 and the right drive wheel 30 are drive wheels in the traveling direction of the self-propelled device 100.
  • a motor 23 is connected to the left drive wheel 21 via a speed reducer 24 provided on the first left support arm 17, and the left drive wheel 21 is driven by the motor 23 to rotate.
  • a motor 32 is connected to the right side drive wheel 30 via a speed reducer 33 provided on the first right side support arm 26, and the right side drive wheel 30 is driven by the motor 32 to rotate.
  • the second wheel portion 35 includes a second support arm 36 provided on the rear side of the frame 11 in the traveling direction of the self-propelled device 100.
  • the second support arm 36 is supported by a support shaft 37 provided on the rear side surface of the frame 11, and is in a vertical plane orthogonal to the traveling direction of the self-propelled device 100. It can swing in the direction.
  • the second support arm 36 has left rear wheels 38 and right rear wheels 40 rotatably supported around the horizontal rotation axes 39 and 41 orthogonal to the traveling direction of the self-propelled device 100 at both ends thereof. Each has.
  • the second wheel portion 35 has a pair of wheels (left rear wheel 38 and right rear wheel 40) configured to be swingable in a plane orthogonal to the traveling direction of the self-propelled device 100.
  • the left rear wheel 38 and the right rear wheel 40 are driven wheels.
  • the left front wheel 19, the right front wheel 28, the left rear wheel 38, and the right rear wheel 40 have the same configuration, and are composed of, for example, an omni wheel.
  • the left front wheel 19 can move in the rotation direction by rotating around the rotation axis 20, and can slide in the horizontal direction intersecting the rotation axis 20 with the rotation direction. ..
  • FIG. 6 is a diagram showing a traveling main body 10 in which the right front wheel 28 rides on the step portion S.
  • FIG. 7 is a diagram showing a traveling main body 10 in which the right rear wheel 40 rides on the step portion S.
  • the first left support arm 17 swings in the direction of arrow D.
  • the left drive wheel 21 which is the drive wheel
  • all the wheels of the left front wheel 19, the right front wheel 28, the right drive wheel 30, the left rear wheel 38, and the right rear wheel 40 are maintained in a state of being in contact with the ground.
  • the first left support arm 17 swings in the direction E indicated by the arrow.
  • all the wheels of the left front wheel 19, the left drive wheel 21, the right front wheel 28, the right drive wheel 30, the left rear wheel 38, and the right rear wheel 40 are maintained in contact with the ground.
  • the second support arm 36 swings in the direction F indicated by the arrow.
  • the left front wheel 19 the left drive wheel 21, the right front wheel 28, the right drive wheel 30, the left rear wheel 38, and the right rear wheel 40 are maintained in contact with the ground.
  • the left rear wheel 38 rides on the step portion S
  • the second support arm 36 swings in the direction of arrow G.
  • all the wheels of the left front wheel 19, the left drive wheel 21, the right front wheel 28, the right drive wheel 30, the left rear wheel 38, and the right rear wheel 40 are maintained in contact with the ground.
  • a step portion S exists on the ground, and the left front wheel 19, the left drive wheel 21, the right front wheel 28, the right drive wheel 30, and the left rear wheel are present in the step portion S. Even if one or more of the 38 and the right rear wheel 40 ride on, the corresponding support arm in the first left side support arm 17, the first right side support arm 26, and the second support arm 36 swings, thereby causing the corresponding support arm to swing. Since this step is absorbed and all the wheels are maintained in contact with the ground, the self-propelled device 100 can travel in a stable state.
  • FIG. 8 is a view showing the traveling body 10 and the laser sensor 105 from above.
  • FIG. 9 is a view showing the traveling body 10 and the laser sensor 105 from the side surface direction.
  • the first wheel portion 15 includes a pair of wheels including the left front wheel 19 and the right front wheel 28.
  • the second wheel portion 35 includes a pair of wheels including the left rear wheel 38 and the right rear wheel 40.
  • the left front wheel 19, the right front wheel 28, the left rear wheel 38, and the right rear wheel 40 are configured to be vertically movable.
  • the concept of "vertical movement" in the present specification may include not only rocking but also movement only in the vertical direction and other movements in which the position in the vertical direction changes.
  • the laser sensor 105 avoids the vertical movement range of the wheels and causes the traveling body 10 to avoid the vertical movement range of the wheels. Need to be provided.
  • the laser sensor 105 is a traveling body 10 so as to remove the upper part of the pair of wheels and so that the scanning surface SC of the laser beam LA is lower than the maximum reaching point P of the vertical movement range of the pair of wheels. It is provided in.
  • the "pair of wheels” here is a concept including a wheel pair of the left front wheel 19 and the right front wheel 28, and a wheel pair of the left rear wheel 38 and the right rear wheel 40.
  • the laser sensor 105 may be provided between the left front wheel 19 and the right front wheel 28, or may be provided between the left rear wheel 38 and the right rear wheel 40 in the top view of the traveling body 10. good.
  • FIG. 8 shows an example in which the laser sensor 105 is provided between the left rear wheel 38 and the right rear wheel 40 in the top view of the traveling body 10.
  • the laser sensor 105 is provided on the traveling body 10 so that the scanning surface SC is lower than "DW + ⁇ H". This makes it possible for the self-propelled device 100 to detect an obstacle at a position lower than the highest reaching point P of the left rear wheel 38 and the right rear wheel 40.
  • the laser sensor 105 is provided on the traveling body 10 so that the scanning surface SC is parallel to the ground GR.
  • the detection range of the laser sensor 105 is set so that the scanning surface SC excludes the traveling main body 10.
  • the detection range of the laser sensor 105 is, for example, about 180 degrees excluding the traveling main body 10 side.
  • the height from the ground GR at the highest reaching point P is 200 mm or more, and the height of the scanning surface SC from the ground GR is 200 mm or less.
  • the self-propelled device 100 can detect a low obstacle at a position of 200 mm or less.
  • it is required to detect a low obstacle having a diameter (height) of 200 mm and a length of 600 mm. The self-propelled device 100 can detect even such a low obstacle.
  • the self-propelled device 100 controls the traveling of the traveling main body 10 based on the detection result of an obstacle by the laser sensor 105.
  • the self-propelled device 100 controls the traveling of the self-propelled device 100 so as to avoid the low obstacle.
  • the self-propelled device 100 stops the traveling of the traveling main body 10 when a low obstacle is detected by the laser sensor 105.
  • the self-propelled device 100 is a self-propelled device so as to avoid a low obstacle when a low obstacle is detected by the laser sensor 105 and the distance to the low obstacle is equal to or more than a predetermined distance.
  • the running of the self-propelled device 100 is controlled, and when the distance to a low obstacle is less than a predetermined distance, the running of the self-propelled device 100 is stopped.
  • the number of laser sensors 105 is arbitrary. At least one laser sensor 105 is between the left front wheel 19 and the right front wheel 28, between the left rear wheel 38 and the right rear wheel 40, between the left front wheel 19 and the left rear wheel 38, or between the right front wheel 28 and the right side. It suffices if it is provided between the rear wheel 40 and the rear wheel 40.
  • FIG. 10 is a view showing the traveling main body 10 and the laser sensors 105A to 105C from above.
  • FIG. 11 is a view showing the traveling main body 10 and the laser sensors 105A to 105C from the side surface direction.
  • the self-propelled device 100 shown in FIGS. 8 and 9 described above includes one laser sensor 105.
  • the self-propelled device 100 according to the present modification includes three laser sensors 105A to 105C.
  • the surface of the traveling main body 10 seen from the forward direction of the self-propelled device 100 will be referred to as "front SF1".
  • the right side of the traveling main body 10 seen from the reverse direction of the self-propelled device 100 is referred to as "right side SF2”.
  • the left surface of the traveling body 10 as seen from the reverse direction of the self-propelled device 100 is referred to as "left surface SF3”.
  • the surface of the self-propelled device 100 when viewed from the reverse direction of the self-propelled device 100 is referred to as "rear surface SF4".
  • the laser sensor 105B (second laser sensor) is provided on the traveling body 10 so as to be located above the right front wheel 28.
  • the laser sensor 105B is arranged so as to overlap with at least a part of the right front wheel 28 in the top view of the traveling body 10.
  • the laser sensor 105B is provided on the traveling body 10 so that the scanning surface SC2 of the output laser light is parallel to the ground.
  • the detection range of the laser sensor 105B is set so that the scanning surface SC2 excludes the traveling main body 10.
  • the detection range of the laser sensor 105B is about 260 degrees (for example, 250 degrees to 270 degrees) excluding the right front corner of the traveling body 10.
  • the laser sensor 105B can detect an obstacle on the front SF1 side and an obstacle on the right SF2 side.
  • the laser sensor 105C (third laser sensor) is provided on the traveling body 10 so as to be located above the left front wheel 19. In other words, the laser sensor 105C is arranged so as to overlap with at least a part of the left front wheel 19 in the top view of the traveling body 10.
  • the laser sensor 105C is provided on the traveling body 10 so that the scanning surface SC3 of the output laser light is parallel to the ground.
  • the detection range of the laser sensor 105C is set so that the scanning surface SC3 excludes the traveling main body 10.
  • the detection range of the laser sensor 105C is 260 degrees (for example, 250 degrees to 270 degrees) excluding the left front corner portion of the traveling body 10.
  • the laser sensor 105C can detect an obstacle on the front SF1 side and an obstacle on the left SF3 side.
  • the direction of the laser beam emitted from the laser sensor 105A includes at least the reverse direction B of the self-propelled device 100.
  • the direction of the laser beam emitted from the laser sensor 105B includes at least one of the forward direction R of the self-propelled apparatus 100 and one direction orthogonal to the forward direction R.
  • the direction of the laser beam emitted from the laser sensor 105C includes at least the forward direction R of the self-propelled device 100 and the other direction orthogonal to the forward direction R.
  • the self-propelled device 100 can detect an obstacle existing at a circumference of 360 degrees.
  • the arrangement positions of the laser sensors 105A to 105C are not limited to the examples shown in FIGS. 10 and 11. As an example, even if the laser sensor 105A is provided between the left front wheel 19 and the right front wheel 28, the laser sensor 105B is provided above the left rear wheel 38, and the laser sensor 105C is provided above the right rear wheel 40. good.
  • the self-propelled device 100 may be provided with four laser sensors.
  • the first laser sensor is provided between the left front wheel 19 and the right front wheel 28
  • the second laser sensor is provided between the left front wheel 19 and the left rear wheel 38
  • the third laser sensor is provided between the right front wheel 28.
  • a fourth laser sensor is provided between the left rear wheel 38 and the right rear wheel 40
  • a fourth laser sensor is provided between the left rear wheel 38 and the right rear wheel 40. All of these four laser sensors are provided at a position where the traveling surface is lower than the highest reaching point P of the wheel.
  • FIG. 12 is a diagram showing an example of the hardware configuration of the self-propelled device 100.
  • the self-propelled device 100 includes a control device 101, a ROM (Read Only Memory) 102, a RAM (Random Access Memory) 103, a communication interface 104, the above-mentioned laser sensor 105 (see FIG. 2), and a motor drive device 106. And the storage device 120. These components are connected to bus 109.
  • the control device 101 is composed of, for example, at least one integrated circuit.
  • the integrated circuit is, for example, at least one CPU (Central Processing Unit), at least one GPU (Graphics Processing Unit), at least one ASIC (Application Specific Integrated Circuit), at least one FPGA (Field Programmable Gate Array), or them. It may be composed of a combination of.
  • the control device 101 is a PLC (Programmable Logic Controller).
  • the control device 101 controls the operation of the self-propelled device 100 by executing various programs such as the control program 122 and the operating system.
  • the control device 101 reads the control program 122 from the storage device 120 or the ROM 102 into the RAM 103 based on the reception of the execution command of the control program 122.
  • the RAM 103 functions as a working memory and temporarily stores various data necessary for executing the control program 122.
  • a LAN Local Area Network
  • an antenna or the like is connected to the communication interface 104.
  • the self-propelled device 100 realizes wireless communication or wired communication with an external device via the communication interface 104.
  • the external device includes, for example, a server (not shown), a user terminal for operating the self-propelled device 100 (not shown), and the like.
  • the user terminal is, for example, a tablet terminal or a smartphone. The user can control the traveling of the self-propelled device 100 via the user terminal.
  • the motor drive device 106 controls the rotation of the above-mentioned motors 23 and 32 (see FIG. 3) according to a control command from the control device 101.
  • the control command includes, for example, a forward rotation command of the motors 23 and 32, a reverse rotation command of the motors 23 and 32, a rotation speed of the motors 23 and 32, and the like.
  • a stepping motor or a servo motor is adopted for the motors 23 and 32.
  • the storage device 120 is a storage medium such as a hard disk or a flash memory.
  • the storage device 120 stores a control program 122 for controlling the travel of the self-propelled device 100, a three-dimensional map 124 that defines a travel route of the self-propelled device 100, and the like.
  • the storage location of the control program 122 and the three-dimensional map 124 is not limited to the storage device 120, but is stored in a storage area of the control device 101 (for example, a cache memory), a ROM 102, a RAM 103, an external device (for example, a server), or the like. May be.
  • control program 122 may be provided by being incorporated into a part of an arbitrary program, not as a single program.
  • the travel control process of the self-propelled device 100 by the control program 122 is realized in cooperation with an arbitrary program. Even a program that does not include such a part of the modules does not deviate from the purpose of the control program 122 according to the present embodiment.
  • some or all of the functions provided by the control program 122 may be realized by dedicated hardware.
  • the self-propelled device 100 may be configured in the form of a so-called cloud service in which at least one server executes a part of the processing of the control program 122.
  • the laser sensor 105 is provided so that the upper portion of the pair of wheels is removed and the scanning surface SC of the laser beam LA is lower than the maximum reaching point P of the vertical movement range of the pair of wheels. , Provided on the traveling body 10. This makes it possible for the self-propelled device 100 to detect an obstacle at a position lower than the highest reaching point P of the left rear wheel 38 and the right rear wheel 40.
  • 10 driving body 11 frame, 12 base, 13 arm robot, 15 first wheel part, 16 first left wheel part, 17 first left support arm, 18, 27, 37 support shaft, 19 left front wheel, 20, 22 , 29, 31, 39, 41 rotary shaft, 21 left drive wheel, 23, 32 motor, 24, 33 reducer, 25 right front wheel part, 26 first right support arm, 28 right front wheel, 30 right drive wheel, 35th 2 wheels, 36 2nd support arm, 38 left rear wheel, 40 right rear wheel, 100 self-propelled device, 101 control device, 102 ROM, 103 RAM, 104 communication interface, 105, 105A, 105B, 105C laser sensor, 106 Motor drive, 109 bus, 110 cover, 120 storage device, 122 control program, 124 3D map.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Electromagnetism (AREA)
  • Radar, Positioning & Navigation (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Mechanical Engineering (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Optics & Photonics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

自走装置（１００）は、車輪駆動の走行本体（１０）を備える。走行本体（１０）は、自走装置（１００）の走行方向に沿って所定間隔を空けて走行本体（１０）に設けられている第１車輪部（１５）および第２車輪部（３５）を含む。第２車輪部（３５）は、自走装置（１００）に対して上下動可能に構成される一対の車輪を有する。自走装置（１００）は、さらに、レーザセンサ（１０５）を備える。レーザセンサ（１０５）は、当該レーザセンサ（１０５）を中心としてレーザ光を回転させながら照射し、当該レーザ光の反射光を受光することで、当該レーザセンサ（１０５）の周囲にある物体を検出するように構成されており、一対の車輪の上部を除くように走行本体（１０）に設けられ、かつ、レーザ光の回転中に当該レーザ光が通過する範囲である走査面が一対の車輪の上下動範囲の最高到達点よりも低くなるように走行本体（１０）に設けられている。

Description

自走装置
　本開示は、車輪駆動の自走装置に関する。
　工場などの生産システムにおいて、無人化が望まれている。無人化を実現するために、自走装置の開発が進められている。自走装置は、加工前のワークや工具などを各工作機械に搬送したり、各工作機械で加工が完了したワークや使用済の工具などを回収したりする。
　特開２０１９－８３５９号公報（特許文献１）は、「マップ情報を良好に作成する」ことを目的とする自走装置を開示している。当該自走装置は、投射光を出射する投光部を回転駆動させ、計測対象物により反射された反射光の受光に基づいて距離測定データを出力する距離測定装置と、距離測定データに基づいてマップ情報を作成するマップ作成部と、障害物を検知する障害物センサとを備えている。
特開２０１９－８３５９号公報
　自走装置の走行は、障害物を避けるように制御される必要がある。当該障害物の一例として、低い位置にある障害物がある。特許文献１に開示される自走装置は、障害物センサが天板部の直下に設けられているため、低い位置にある障害物を検出することができない。
　また、自走装置の車輪は、走行時の衝撃を吸収するために、上下動するように構成されている。このような車輪の上部にレーザセンサが設けられる場合には、車輪の上下動の範囲のさらに上部にレーザセンサが設けられなければならない。この場合には、自走装置は、低い位置にある障害物を検出することができない。そのため、上下動可能な車輪を備える自走装置であっても低い位置にある障害物を検出することが望まれている。
　本開示の一例では、自走装置は、車輪駆動の走行本体を備える。上記走行本体は、上記自走装置の走行方向に沿って所定間隔を空けて上記走行本体に設けられている第１車輪部および第２車輪部を含む。上記第２車輪部は、上記自走装置に対して上下動可能に構成される一対の車輪を有する。上記自走装置は、さらに、第１レーザセンサを備える。上記第１レーザセンサは、当該第１レーザセンサを中心としてレーザ光を回転させながら照射し、当該レーザ光の反射光を受光することで、当該第１レーザセンサの周囲にある物体を検出するように構成されており、上記一対の車輪の上部を除くように上記走行本体に設けられ、かつ、上記レーザ光の回転中に当該レーザ光が通過する範囲である走査面が上記一対の車輪の上下動範囲の最高到達点よりも低くなるように上記走行本体に設けられている。
　本開示の一例では、上記第１レーザセンサは、上記走行本体の上面視において、上記一対の車輪の間に設けられている。
　本開示の一例では、上記第１車輪部は、第１前輪および第２前輪を有する。上記一対の車輪は、第１後輪および第２後輪である。
　本開示の一例では、上記自走装置は、さらに、上記第１レーザセンサと同機能の第２レーザセンサと、上記第１レーザセンサと同機能の第３レーザセンサとを備える。上記第２レーザセンサは、上記第１前輪の上部に位置するように上記走行本体に設けられている。上記第３レーザセンサは、上記第２前輪の上部に位置するように上記走行本体に設けられている。
　本開示の一例では、上記第１レーザセンサから照射されるレーザ光の方向は、上記自走装置の後進方向を少なくとも含む。上記第２レーザセンサから照射されるレーザ光の方向は、上記自走装置の前進方向と、当該前進方向と直交する一方の方向とを少なくとも含む。上記第３レーザセンサから照射されるレーザ光の方向は、上記自走装置の前進方向と、当該前進方向と直交する他方の方向とを少なくとも含む。
　本開示の一例では、上記最高到達点における地面からの高さは、２００ｍｍ以上である。上記走査面の地面からの高さは、２００ｍｍ以下である。
　本開示の一例では、上記一対の車輪を上下動可能に構成することは、自走装置１００の走行方向と直交する平面内で揺動可能に構成することを含む。
　本開示の一例では、上記一対の車輪は、オムニホイールである。
　本発明の上記および他の目的、特徴、局面および利点は、添付の図面と関連して理解される本発明に関する次の詳細な説明から明らかとなるであろう。
自走装置の外観を示す図である。 レーザセンサと、レーザセンサから出力される２次元距離データとを示す図である。 走行本体の内部構造の概略を示す図である。 走行本体の側面図を示す図である。 図３に示される後進方向Ｂから走行本体を示す図である。 右側前輪が段差部に乗り上げている走行本体を示す図である。 右側後輪が段差部に乗り上げている走行本体を示す図である。 走行本体およびレーザセンサを上方向から表わした図である。 走行本体およびレーザセンサを側面方向から表わした図である。 走行本体およびレーザセンサを上方向から表わした図である。 走行本体およびレーザセンサを側面方向から表わした図である。 自走装置のハードウェア構成の一例を示す図である。
　以下、図面を参照しつつ、本発明に従う各実施の形態について説明する。以下の説明では、同一の部品および構成要素には同一の符号を付してある。それらの名称および機能も同じである。したがって、これらについての詳細な説明は繰り返さない。なお、以下で説明される各実施の形態および各変形例は、適宜選択的に組み合わされてもよい。
　＜Ａ．自走装置１００＞
　まず、図１を参照して、自走装置１００について説明する。図１は、自走装置１００の外観を示す図である。
　自走装置１００は、ワークや工具などの搬送対象物を任意の場所に搬送する。自走装置１００は、車輪駆動の走行本体１０と、基台１２と、アームロボット１３とを含む。
　基台１２は、走行本体１０の上部に固定されている。基台１２は、カバー１１０を有する。カバー１１０の内部には、後述のレーザセンサ１０５（図２参照）が設けられる。自走装置１００は、レーザセンサ１０５の検知結果に基づいて、前進方向Ｒ、後進方向Ｂ、右折、左折などの走行本体１０の走行を制御する。
　アームロボット１３は、基台１２上に設けられている。また、基台１２上には、ワークＷの置き場が設けられている。アームロボット１３は、ワークＷを把持し、指定された場所に当該ワークＷを移動する。
　なお、上述では、４～７軸駆動のアームロボット１３が走行本体１０上に設置されている例について説明を行ったが、ワークまたは工具などの搬送対象物を搬送することが可能な種々の搬送装置が走行本体１０上に設置され得る。当該搬送装置は、２～３軸駆動のロボット（たとえば、オートローダ）であってもよい。
　＜Ｂ．レーザセンサ１０５＞
　次に、図２を参照して、自走装置１００のカバー１１０内に設けられているレーザセンサ１０５について説明する。図２は、レーザセンサ１０５と、レーザセンサ１０５から出力される２次元距離データＤ１とを示す図である。
　レーザセンサ１０５は、レーザセンサ１０５の中心軸ＡＸを回転中心としてレーザ光ＬＡを回転させながら照射し、当該レーザ光ＬＡの反射光を受光するように構成される。これにより、レーザセンサ１０５は、周囲にある物体までの距離を、中心軸ＡＸを基準とする角度別に表わした２次元距離データＤ１を出力する。２次元距離データＤ１は、走査面ＳＣ内に存在する各物体までの距離を照射角度別に表わす。
　より具体的には、レーザセンサ１０５は、照射部と、ミラーと、受光部とで構成される。当該照射部は、当該ミラーに向けてレーザ光を照射する。当該ミラーは、モーター（図示しない）によって中心軸ＡＸを回転中心として回転可能にされており、レーザ光ＬＡを各方向に反射する。これにより、レーザセンサ１０５は、レーザ光ＬＡを各方向に照射する。物体がレーザセンサ１０５の周囲にある場合には、レーザ光ＬＡは、当該物体に反射され、レーザセンサ１０５に戻る。レーザセンサ１０５は、当該反射光を受光部で受ける。
　レーザセンサ１０５は、物体からの反射光を受けて、当該物体までの距離を算出する。一例として、レーザセンサ１０５は、レーザ光ＬＡを照射してから、当該レーザ光ＬＡの反射光を受光するまでの時間に基づいて、レーザセンサ１０５から物体までの距離を算出する。典型的には、レーザセンサ１０５は、光の速度に当該時間を掛けることで物体までの距離を算出する。レーザセンサ１０５は、当該距離をレーザ光ＬＡの照射角度に対応付けることで、中心軸ＡＸを基準とする角度別に距離を表わした２次元距離データＤ１を出力する。
　レーザセンサ１０５が出力する距離データの角度範囲は、任意に設定される。図２の例では、０度～２７０度の角度範囲が有効に設定されている。
　以上のようにして、レーザセンサ１０５は、レーザセンサ１０５を中心としてレーザ光ＬＡを回転させながら照射し、当該レーザ光ＬＡの反射光を受光することで、レーザセンサ１０５の周囲にある物体を検出する。
　＜Ｃ．走行本体１０の構成＞
　次に、図３～図５を参照して、図１に示され走行本体１０について説明する。図３は、走行本体１０の内部構造の概略を示す図である。図４は、走行本体１０の側面図を示す図である。図５は、図３に示される後進方向Ｂから走行本体１０を示す図である。
　図３～図５に示されるように、走行本体１０は、フレーム１１と、前輪として機能する第１車輪部１５と、後輪として機能する第２車輪部３５とを備える。
　フレーム１１は、必要な構造物を配設可能なように、平面から見て適宜切り欠いた空間を有するとともに、軽量化を図るために、内側が中空になった構造を有する。
　第１車輪部１５および第２車輪部３５は、走行方向（矢示Ｒ方向）に沿って所定間隔を空けてフレーム１１に接続されている。当該走行方向は、自走装置１００の前進方向または後進方向を示す。
　第１車輪部１５は、自走装置１００の背面から見て左側に設けられた第１左側車輪部１６と、自走装置１００の背面から見て右側に設けられた右側前輪部２５とからなる。
　第１左側車輪部１６は、フレーム１１の左側の側面に設けられた第１左側支持アーム１７と、左側前輪１９と、左側駆動輪２１とを備える。左側前輪１９および左側駆動輪２１は、自走装置１００の走行方向と直交する水平な回転軸２０，２２を中心として回転自在なように第１左側支持アーム１７の両端部に支持されている。
　右側前輪部２５は、フレーム１１の右側の側面に設けられた第１右側支持アーム２６と、右側前輪２８と、右側駆動輪３０とを備えている。右側前輪２８および右側駆動輪３０は、自走装置１００の走行方向と直交する水平な回転軸２９，３１を中心として回転自在なように第１右側支持アーム２６の両端に支持されている。
　第１右側支持アーム２６は、フレーム１１の右側面に設けられた支持軸２７によって支持され、自走装置１００の走行方向に沿った垂直平面内で、図４に示した矢示Ｄ－Ｅ方向に揺動可能になっている。同様に、第１左側支持アーム１７はフレーム１１の左側面に設けられた支持軸１８によって支持され、自走装置１００の走行方向に沿った垂直平面内で矢示Ｄ－Ｅ方向と同じ方向に揺動可能になっている。
　なお、本例では、自走装置１００の走行方向に向かって左側前輪１９および右側前輪２８が従動輪となっており、左側駆動輪２１および右側駆動輪３０が駆動輪となっている。そして、左側駆動輪２１には、第１左側支持アーム１７に設けられた減速機２４を介してモータ２３が接続され、左側駆動輪２１は、モータ２３により駆動されて回転する。同様に、右側駆動輪３０には、第１右側支持アーム２６に設けられた減速機３３を介してモータ３２が接続され、右側駆動輪３０は、モータ３２により駆動されて回転する。
　第２車輪部３５は、自走装置１００の走行方向に向かってフレーム１１の後側に設けられた第２支持アーム３６を備えている。第２支持アーム３６は、フレーム１１の後側の側面に設けられた支持軸３７によって支持され、自走装置１００の走行方向と直交する垂直平面内で、図５に示した矢示Ｆ－Ｇ方向に揺動可能になっている。また、第２支持アーム３６は、その両端部に、自走装置１００の走行方向と直交する水平な回転軸３９，４１を中心として回転自在に支持された左側後輪３８および右側後輪４０をそれぞれ備えている。このように、第２車輪部３５は、自走装置１００の走行方向と直交する平面内で揺動可能に構成される一対の車輪（左側後輪３８および右側後輪４０）を有する。なお、左側後輪３８および右側後輪４０は、従動輪となっている。
　左側前輪１９、右側前輪２８、左側後輪３８、および右側後輪４０は、同じ構成を備えるもので、たとえば、オムニホイールから構成される。この場合、左側前輪１９は、回転軸２０を中心として回転することによりその回転方向に進むことができるとともに、回転軸２０と回転方向と交差する水平方向にスライドすることができるようになっている。
　＜Ｄ．走行本体１０の走行態様＞
　次に、図６および図７を参照して、自走装置１００が段差に乗り上げた際の走行態様について説明する。図６は、右側前輪２８が段差部Ｓに乗り上げている走行本体１０を示す図である。図７は、右側後輪４０が段差部Ｓに乗り上げている走行本体１０を示す図である。
　図６に示されるように、自走装置１００が工場内を走行する場合、右側前輪２８が工場内に設けられた段差部Ｓに乗り上がると、第１右側支持アーム２６は、矢示Ｄ方向に揺動する。これにより、駆動輪である右側駆動輪３０の他、左側前輪１９、左側駆動輪２１、右側前輪２８、左側後輪３８、および右側後輪４０の全ての車輪が地面に接地した状態が維持される。一方、右側駆動輪３０が段差部Ｓに乗り上がる場合には、第１右側支持アーム２６は、矢示柄Ｅ方向に揺動する。これにより、左側前輪１９、左側駆動輪２１、右側前輪２８、右側駆動輪３０、左側後輪３８、および右側後輪４０の全ての車輪が地面に接地した状態が維持される。
　同様に、左側前輪１９が段差部Ｓに乗り上がると、第１左側支持アーム１７は、矢示Ｄ方向に揺動する。これにより、駆動輪である左側駆動輪２１の他、左側前輪１９、右側前輪２８、右側駆動輪３０、左側後輪３８、および右側後輪４０の全ての車輪が地面に接地した状態が維持される。また、左側駆動輪２１が段差部Ｓに乗り上がる場合には、第１左側支持アーム１７が矢示Ｅ方向に揺動する。これにより、左側前輪１９、左側駆動輪２１、右側前輪２８、右側駆動輪３０、左側後輪３８、および右側後輪４０の全ての車輪が地面に接地した状態が維持される。
　また、図７に示されるように、右側後輪４０が段差部Ｓに乗り上がると、第２支持アーム３６は、矢示Ｆ方向に揺動する。これにより、左側前輪１９、左側駆動輪２１、右側前輪２８、右側駆動輪３０、左側後輪３８、および右側後輪４０の全ての車輪が地面に接地した状態が維持される。一方、左側後輪３８が段差部Ｓに乗り上がる場合には、第２支持アーム３６は、矢示Ｇ方向に揺動する。これにより、左側前輪１９、左側駆動輪２１、右側前輪２８、右側駆動輪３０、左側後輪３８、および右側後輪４０の全ての車輪が地面に接地した状態が維持される。
　このように、本例の自走装置１００によれば、地面に段差部Ｓが存在し、この段差部Ｓに左側前輪１９、左側駆動輪２１、右側前輪２８、右側駆動輪３０、左側後輪３８、および右側後輪４０の内の一以上が乗り上げても、第１左側支持アーム１７、第１右側支持アーム２６および第２支持アーム３６の内の対応する支持アームが揺動することによって、この段差分が吸収され、全ての車輪が地面に接地した状態が維持されるので、自走装置１００は安定した状態で走行することができる。
　＜Ｅ．レーザセンサ１０５の配置位置＞
　次に、図８および図９を参照して、自走装置１００におけるレーザセンサ１０５の配置位置について説明する。図８は、走行本体１０およびレーザセンサ１０５を上方向から表わした図である。図９は、走行本体１０およびレーザセンサ１０５を側面方向から表わした図である。
　上述のように、第１車輪部１５は、左側前輪１９および右側前輪２８からなる一対の車輪を含む。また、第２車輪部３５は、左側後輪３８および右側後輪４０からなる一対の車輪を含む。図４～図７で説明したように、左側前輪１９、右側前輪２８、左側後輪３８、および右側後輪４０は、上下動可能に構成される。本明細書における「上下動」との概念は、揺動だけでなく、上下方向のみの動作、上下方向の位置が変化するその他の動作も含み得る。
　このような自走装置１００が低い位置にある障害物（以下、「低障害物」ともいう。）を検出するためには、レーザセンサ１０５は、車輪の上下動範囲を避けて走行本体１０に設けられる必要がある。
　そこで、レーザセンサ１０５は、一対の車輪の上部を除くように、かつ、レーザ光ＬＡの走査面ＳＣが当該一対の車輪の上下動範囲の最高到達点Ｐよりも低くなるように、走行本体１０に設けられる。ここでいう「一対の車輪」とは、左側前輪１９と右側前輪２８との車輪対、および、左側後輪３８と右側後輪４０との車輪対を含む概念である。
　すなわち、レーザセンサ１０５は、走行本体１０の上面視において、左側前輪１９と右側前輪２８との間に設けられてもよいし、左側後輪３８と右側後輪４０との間に設けられてもよい。図８には、レーザセンサ１０５が走行本体１０の上面視において左側後輪３８と右側後輪４０との間に設けられている例が示されている。
　より具体的には、左側後輪３８および右側後輪４０の直径を「ＤＷ」、上下方向における左側後輪３８および右側後輪４０の動作範囲を「ΔＨ」とした場合、左側後輪３８および右側後輪４０の最高到達点Ｐは「ＤＷ＋ΔＨ」となる。この場合、レーザセンサ１０５は、走査面ＳＣが「ＤＷ＋ΔＨ」よりも低くなるように走行本体１０に設けられる。これにより、自走装置１００は、左側後輪３８および右側後輪４０の最高到達点Ｐよりも低い位置にある障害物を検出することが可能になる。
　典型的には、レーザセンサ１０５は、走査面ＳＣが地面ＧＲと平行になるように走行本体１０に設けられる。一例として、走査面ＳＣが走行本体１０を除くようにレーザセンサ１０５の検出範囲が設定される。レーザセンサ１０５の検出範囲は、たとえば、走行本体１０側を除く約１８０度である。
　好ましくは、最高到達点Ｐにおける地面ＧＲからの高さは、２００ｍｍ以上であり、走査面ＳＣの地面ＧＲからの高さは、２００ｍｍ以下である。これにより、自走装置１００は、２００ｍｍ以下の位置にある低障害物を検出することができる。特に、「ＩＳＯ３６９１－４　５．２項」では、直径（高さ）２００ｍｍ、長さ６００ｍｍの低障害物を検出することが求められている。自走装置１００は、このような低障害物でも検出することが可能になる。
　自走装置１００は、レーザセンサ１０５による障害物の検出結果に基づいて、走行本体１０の走行を制御する。
　ある局面において、自走装置１００は、レーザセンサ１０５によって低障害物が検出された場合には、当該低障害物を避けるように自走装置１００の走行を制御する。
　他の局面において、自走装置１００は、レーザセンサ１０５によって低障害物が検出された場合には、走行本体１０の走行を停止する。
　他の局面において、自走装置１００は、レーザセンサ１０５によって低障害物が検出された場合において、低障害物までの距離が所定距離以上であるときには、当該低障害物を避けるように自走装置１００の走行を制御し、低障害物までの距離が所定距離未満であるときには、自走装置１００の走行を停止する。
　なお、上述では、１つのレーザセンサ１０５が自走装置１００に設けられている例について説明を行ったが、レーザセンサ１０５の数は、任意である。少なくとも１つのレーザセンサ１０５が、左側前輪１９と右側前輪２８との間、左側後輪３８と右側後輪４０との間、左側前輪１９と左側後輪３８との間、または右側前輪２８と右側後輪４０との間の設けられていればよい。
　＜Ｆ．変形例＞
　次に、図１０および図１１を参照して、自走装置１００の変形例について説明する。図１０は、走行本体１０およびレーザセンサ１０５Ａ～１０５Ｃを上方向から表わした図である。図１１は、走行本体１０およびレーザセンサ１０５Ａ～１０５Ｃを側面方向から表わした図である。
　上述の図８および図９に示される自走装置１００は、１つのレーザセンサ１０５を備えていた。これに対して、本変形例に従う自走装置１００は、３つのレーザセンサ１０５Ａ～１０５Ｃを備える。
　レーザセンサ１０５Ａ～１０５Ｃの機能および構造については、上述のレーザセンサ１０５（図２参照）と同じであるので、その説明については繰り返さない。
　また、レーザセンサ１０５Ａの配置位置については、上述の図８および図９に示されるレーザセンサ１０５と同じであるので、その説明については繰り返さない。
　以下では、自走装置１００の前進方向から見た走行本体１０の面を「前面ＳＦ１」と称する。また、自走装置１００の後進方向から見た走行本体１０の右面を「右面ＳＦ２」と称する。また、自走装置１００の後進方向から見た走行本体１０の左面を「左面ＳＦ３」と称する。また、自走装置１００の後進方向から見た場合の自走装置１００の面を「後面ＳＦ４」と称する。
　レーザセンサ１０５Ｂ（第２レーザセンサ）は、右側前輪２８の上部に位置するように走行本体１０に設けられる。異なる言い方をすれば、レーザセンサ１０５Ｂは、走行本体１０の上面視において、右側前輪２８の少なくとも一部と重複するように配置される。
　また、レーザセンサ１０５Ｂは、出力されるレーザ光の走査面ＳＣ２が地面と平行になるように走行本体１０に設けられる。好ましくは、走査面ＳＣ２が走行本体１０を除くようにレーザセンサ１０５Ｂの検出範囲が設定される。一例として、レーザセンサ１０５Ｂの検出範囲は、走行本体１０の右前角部を除く約２６０度（たとえば、２５０度～２７０度）である。これにより、レーザセンサ１０５Ｂは、前面ＳＦ１側にある障害物と、右面ＳＦ２側にある障害物とを検知することができる。
　レーザセンサ１０５Ｃ（第３レーザセンサ）は、左側前輪１９の上部に位置するように走行本体１０に設けられる。異なる言い方をすれば、レーザセンサ１０５Ｃは、走行本体１０の上面視において、左側前輪１９の少なくとも一部と重複するように配置される。
　また、レーザセンサ１０５Ｃは、出力されるレーザ光の走査面ＳＣ３が地面と平行になるように走行本体１０に設けられる。好ましくは、走査面ＳＣ３が走行本体１０を除くようにレーザセンサ１０５Ｃの検出範囲が設定される。一例として、レーザセンサ１０５Ｃの検出範囲は、走行本体１０の左前角部を除く２６０度（たとえば、２５０度～２７０度）である。これにより、レーザセンサ１０５Ｃは、前面ＳＦ１側にある障害物と、左面ＳＦ３側にある障害物とを検知することができる。
　以上のように、レーザセンサ１０５Ａから照射されるレーザ光の方向は、自走装置１００の後進方向Ｂを少なくとも含む。また、レーザセンサ１０５Ｂから照射されるレーザ光の方向は、自走装置１００の前進方向Ｒと、前進方向Ｒと直交する一方の方向とを少なくとも含む。また、レーザセンサ１０５Ｃから照射されるレーザ光の方向は、自走装置１００の前進方向Ｒと、前進方向Ｒと直交する他方の方向とを少なくとも含む。これにより、自走装置１００は、周囲３６０度に存在する障害物を検出できるようになる。
　なお、レーザセンサ１０５Ａ～１０５Ｃの配置位置は、図１０および図１１に示される例に限定されない。一例として、レーザセンサ１０５Ａが左側前輪１９と右側前輪２８との間に設けられ、レーザセンサ１０５Ｂが左側後輪３８の上部に設けられ、レーザセンサ１０５Ｃが右側後輪４０の上部に設けられてもよい。
　また、上述では、３つのレーザセンサ１０５Ａ～１０５Ｃが自走装置１００に設けられている例について説明を行ったが、自走装置１００には４つのレーザセンサが設けられてもよい。この場合、第１レーザセンサが左側前輪１９と右側前輪２８との間に設けられ、第２レーザセンサが左側前輪１９と左側後輪３８との間に設けられ、第３レーザセンサが右側前輪２８と右側後輪４０との間に設けられ、第４レーザセンサが左側後輪３８と右側後輪４０との間に設けられる。これら４つのレーザセンサは、いずれも走行面が車輪の最高到達点Ｐよりも低い位置に設けられる。
　＜Ｇ．自走装置１００のハードウェア構成＞
　次に、図１２を参照して、自走装置１００のハードウェア構成について説明する。図１２は、自走装置１００のハードウェア構成の一例を示す図である。
　自走装置１００は、制御装置１０１と、ＲＯＭ（Read　Only　Memory）１０２と、ＲＡＭ（Random　Access　Memory）１０３と、通信インターフェイス１０４と、上述のレーザセンサ１０５（図２参照）と、モータ駆動装置１０６と、記憶装置１２０とを含む。これらのコンポーネントは、バス１０９に接続される。
　制御装置１０１は、たとえば、少なくとも１つの集積回路によって構成される。集積回路は、たとえば、少なくとも１つのＣＰＵ（Central　Processing　Unit）、少なくとも１つのＧＰＵ（Graphics Processing Unit）、少なくとも１つのＡＳＩＣ（Application　Specific　Integrated　Circuit）、少なくとも１つのＦＰＧＡ（Field　Programmable　Gate　Array）、またはそれらの組み合わせなどによって構成され得る。一例として、制御装置１０１は、ＰＬＣ（Programmable Logic Controller）である。
　制御装置１０１は、制御プログラム１２２やオペレーティングシステムなどの各種プログラムを実行することで自走装置１００の動作を制御する。制御装置１０１は、制御プログラム１２２の実行命令を受け付けたことに基づいて、記憶装置１２０またはＲＯＭ１０２からＲＡＭ１０３に制御プログラム１２２を読み出す。ＲＡＭ１０３は、ワーキングメモリとして機能し、制御プログラム１２２の実行に必要な各種データを一時的に格納する。
　通信インターフェイス１０４には、ＬＡＮ（Local　Area　Network）やアンテナなどが接続される。自走装置１００は、通信インターフェイス１０４を介して外部機器との無線通信または有線通信を実現する。当該外部機器は、たとえば、サーバー（図示しない）、自走装置１００を操作するためのユーザ端末（図示しない）などを含む。当該ユーザ端末は、たとえば、タブレット端末やスマートフォンなどである。ユーザは、当該ユーザ端末を介して自走装置１００の走行を制御することができる。
　モータ駆動装置１０６は、制御装置１０１からの制御指令に従って、上述のモータ２３，３２（図３参照）の回転を制御する。当該制御指令は、たとえば、モータ２３，３２の正転指令、モータ２３，３２の逆転指令、モータ２３，３２の回転速度などを含む。モータ２３，３２には、たとえば、ステッピングモータまたはサーボモータなどが採用される。
　記憶装置１２０は、たとえば、ハードディスクやフラッシュメモリなどの記憶媒体である。記憶装置１２０は、自走装置１００の走行を制御するための制御プログラム１２２、および、自走装置１００の走行経路を規定する３次元マップ１２４などを格納する。制御プログラム１２２および３次元マップ１２４の格納場所は、記憶装置１２０に限定されず、制御装置１０１の記憶領域（たとえば、キャッシュメモリなど）、ＲＯＭ１０２、ＲＡＭ１０３、外部機器（たとえば、サーバー）などに格納されていてもよい。
　また、制御プログラム１２２は、単体のプログラムとしてではなく、任意のプログラムの一部に組み込まれて提供されてもよい。この場合、制御プログラム１２２による自走装置１００の走行制御処理は、任意のプログラムと協働して実現される。このような一部のモジュールを含まないプログラムであっても、本実施の形態に従う制御プログラム１２２の趣旨を逸脱するものではない。さらに、制御プログラム１２２によって提供される機能の一部または全部は、専用のハードウェアによって実現されてもよい。さらに、少なくとも１つのサーバーが制御プログラム１２２の処理の一部を実行する所謂クラウドサービスのような形態で自走装置１００が構成されてもよい。
　＜Ｈ．まとめ＞
　以上のようにして、レーザセンサ１０５は、一対の車輪の上部を除くように、かつ、レーザ光ＬＡの走査面ＳＣが当該一対の車輪の上下動範囲の最高到達点Ｐよりも低くなるように、走行本体１０に設けられる。これにより、自走装置１００は、左側後輪３８および右側後輪４０の最高到達点Ｐよりも低い位置にある障害物を検出することが可能になる。
　今回開示された実施の形態は全ての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて請求の範囲によって示され、請求の範囲と均等の意味および範囲内での全ての変更が含まれることが意図される。
　１０　走行本体、１１　フレーム、１２　基台、１３　アームロボット、１５　第１車輪部、１６　第１左側車輪部、１７　第１左側支持アーム、１８，２７，３７　支持軸、１９　左側前輪、２０，２２，２９，３１，３９，４１　回転軸、２１　左側駆動輪、２３，３２　モータ、２４，３３　減速機、２５　右側前輪部、２６　第１右側支持アーム、２８　右側前輪、３０　右側駆動輪、３５　第２車輪部、３６　第２支持アーム、３８　左側後輪、４０　右側後輪、１００　自走装置、１０１　制御装置、１０２　ＲＯＭ、１０３　ＲＡＭ、１０４　通信インターフェイス、１０５，１０５Ａ，１０５Ｂ，１０５Ｃ　レーザセンサ、１０６　モータ駆動装置、１０９　バス、１１０　カバー、１２０　記憶装置、１２２　制御プログラム、１２４　３次元マップ。

Claims (8)

  1. 　自走装置であって、
    　車輪駆動の走行本体を備え、
    　前記走行本体は、前記自走装置の走行方向に沿って所定間隔を空けて前記走行本体に設けられている第１車輪部および第２車輪部を含み、
    　前記第２車輪部は、前記自走装置に対して上下動可能に構成される一対の車輪を有し、
    　前記自走装置は、さらに、第１レーザセンサを備え、
    　前記第１レーザセンサは、
    　　当該第１レーザセンサを中心としてレーザ光を回転させながら照射し、当該レーザ光の反射光を受光することで、当該第１レーザセンサの周囲にある物体を検出するように構成されており、
    　　前記一対の車輪の上部を除くように前記走行本体に設けられ、かつ、前記レーザ光の回転中に当該レーザ光が通過する範囲である走査面が前記一対の車輪の上下動範囲の最高到達点よりも低くなるように前記走行本体に設けられている、自走装置。
  2. 　前記第１レーザセンサは、前記走行本体の上面視において、前記一対の車輪の間に設けられている、請求項１に記載の自走装置。
  3. 　前記第１車輪部は、第１前輪および第２前輪を有し、
    　前記一対の車輪は、第１後輪および第２後輪である、請求項１または２に記載の自走装置。
  4. 　前記自走装置は、さらに、
    　　前記第１レーザセンサと同機能の第２レーザセンサと、
    　　前記第１レーザセンサと同機能の第３レーザセンサとを備え、
    　前記第２レーザセンサは、前記第１前輪の上部に位置するように前記走行本体に設けられており、
    　前記第３レーザセンサは、前記第２前輪の上部に位置するように前記走行本体に設けられている、請求項３に記載の自走装置。
  5. 　前記第１レーザセンサから照射されるレーザ光の方向は、前記自走装置の後進方向を少なくとも含み、
    　前記第２レーザセンサから照射されるレーザ光の方向は、前記自走装置の前進方向と、当該前進方向と直交する一方の方向とを少なくとも含み、
    　前記第３レーザセンサから照射されるレーザ光の方向は、前記自走装置の前進方向と、当該前進方向と直交する他方の方向とを少なくとも含む、請求項４に記載の自走装置。
  6. 　前記最高到達点における地面からの高さは、２００ｍｍ以上であり、
    　前記走査面の地面からの高さは、２００ｍｍ以下である、請求項１～５のいずれか１項に記載の自走装置。
  7. 　前記一対の車輪を上下動可能に構成することは、自走装置１００の走行方向と直交する平面内で揺動可能に構成することを含む、請求項１～６のいずれか１項に記載の自走装置。
  8. 　前記一対の車輪は、オムニホイールである、請求項１～７のいずれか１項に記載の自走装置。
PCT/JP2020/046229 2020-12-11 2020-12-11 自走装置 WO2022123762A1 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
US18/266,154 US20240094738A1 (en) 2020-12-11 2020-12-11 Autonomous Traveling Apparatus
CN202080107776.7A CN116615698A (zh) 2020-12-11 2020-12-11 自行装置
JP2022534793A JP7266757B2 (ja) 2020-12-11 2020-12-11 自走装置
EP20965144.7A EP4250043A1 (en) 2020-12-11 2020-12-11 Self-propelled device
PCT/JP2020/046229 WO2022123762A1 (ja) 2020-12-11 2020-12-11 自走装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2020/046229 WO2022123762A1 (ja) 2020-12-11 2020-12-11 自走装置

Publications (1)

Publication Number Publication Date
WO2022123762A1 true WO2022123762A1 (ja) 2022-06-16

Family

ID=81974318

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/046229 WO2022123762A1 (ja) 2020-12-11 2020-12-11 自走装置

Country Status (5)

Country Link
US (1) US20240094738A1 (ja)
EP (1) EP4250043A1 (ja)
JP (1) JP7266757B2 (ja)
CN (1) CN116615698A (ja)
WO (1) WO2022123762A1 (ja)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009301401A (ja) * 2008-06-16 2009-12-24 Panasonic Electric Works Co Ltd 自律移動装置
JP2014186695A (ja) * 2013-03-25 2014-10-02 Murata Mach Ltd 自律移動装置
JP2019008359A (ja) 2017-06-20 2019-01-17 日本電産シンポ株式会社 移動装置
JP6779398B1 (ja) * 2020-02-06 2020-11-04 Dmg森精機株式会社 走行装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009301401A (ja) * 2008-06-16 2009-12-24 Panasonic Electric Works Co Ltd 自律移動装置
JP2014186695A (ja) * 2013-03-25 2014-10-02 Murata Mach Ltd 自律移動装置
JP2019008359A (ja) 2017-06-20 2019-01-17 日本電産シンポ株式会社 移動装置
JP6779398B1 (ja) * 2020-02-06 2020-11-04 Dmg森精機株式会社 走行装置

Also Published As

Publication number Publication date
JP7266757B2 (ja) 2023-04-28
CN116615698A (zh) 2023-08-18
JPWO2022123762A1 (ja) 2022-06-16
US20240094738A1 (en) 2024-03-21
EP4250043A1 (en) 2023-09-27

Similar Documents

Publication Publication Date Title
JP5337408B2 (ja) 自律移動体及びその移動制御方法
KR102024387B1 (ko) 로봇암의 가능한 위치들을 결정하기 위한 방법
ES2621193T3 (es) Sistema, dispositivo y método de guiado por láser óptico
KR101374616B1 (ko) 자율 이동체와 그 제어 방법
JP2008273344A (ja) 倒立車輪型移動体、及びその制御方法
JP2015032182A (ja) 自律移動装置およびその制御方法
JP2008020370A (ja) 自律移動装置
JP4670807B2 (ja) 移動経路作成方法、自律移動体および自律移動体制御システム
CN105739503A (zh) 一种行走机器人拐弯调头的方法及控制设备
JP2016085689A (ja) 自律移動装置
JP2023157020A (ja) 自走装置
WO2022123762A1 (ja) 自走装置
US20240100691A1 (en) Self-propelled Device
JP6944611B1 (ja) 自走装置および自走装置の走行システム
JP4973303B2 (ja) 倒立型移動体および倒立型移動体の移動停止方法
JP6970852B1 (ja) 走行システム
JP6935032B1 (ja) 自走装置
JP2023124073A (ja) 搬送装置、制御方法、および制御プログラム
JPH01149114A (ja) 自走ロボットの走行制御方法
JP7062843B1 (ja) 搬送ロボット、搬送方法、および制御プログラム
JP7188207B2 (ja) 自律走行車の走行制御方法
JP7185078B1 (ja) 自走装置、自走装置の制御方法、および自走装置の制御プログラム
JP7387933B1 (ja) 走行装置
US20220281727A1 (en) Movable body, method for controlling movable body, and non-transitory computer readable storage medium storing program
JP7432868B2 (ja) 移動体、搬送装置、及び部品実装システム

Legal Events

Date Code Title Description
ENP Entry into the national phase

Ref document number: 2022534793

Country of ref document: JP

Kind code of ref document: A

121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20965144

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 202080107776.7

Country of ref document: CN

WWE Wipo information: entry into national phase

Ref document number: 18266154

Country of ref document: US

ENP Entry into the national phase

Ref document number: 2020965144

Country of ref document: EP

Effective date: 20230619

NENP Non-entry into the national phase

Ref country code: DE