Movable body autonomously movable straddling groove in floor in space and program
The snake-shaped robot system addresses control challenges in grooved environments by using a multi-connection mechanism and closed-loop attitude control, enabling autonomous navigation and inspection in complex spaces.
Patent Information
- Application Number
- JP2023084240
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-23
- Publication Date
- 2024-12-05
- Estimated Expiration
- 2043-05-23
AI Technical Summary
Existing snake-shaped robots face challenges in controlling their movements in complex environments with grooves, such as drainage ditches, due to difficulties in remote operation and posture control, especially in areas with poor radio wave conditions, making autonomous operation in underground spaces like building inspections risky.
A snake-shaped robot system with a multi-connection mechanism, including joints and a driving mechanism, equipped with map information and self-position estimation, allows it to autonomously navigate grooves by controlling its posture to avoid prohibited areas and prevent derailment, using a closed-loop system for attitude control.
Enables the snake-shaped robot to autonomously traverse floor surfaces with grooves, performing inspections efficiently without getting stuck or losing self-position recognition, even in hazardous environments with poor communication.
Smart Images

Figure 2024167926000001_ABST
Abstract
Description
[Technical field]
[0001] The present invention relates to an autonomous robot, an autonomous robot control method, and an inspection system using an autonomous robot, and in particular to an autonomous robot having a snake-like shape. [Background technology]
[0002] Buildings and other structures have electricity, gas, and water pipes and pumps for pumping groundwater, and these facilities are mainly installed in the building's underground space (also called an underground pit). When a building is newly constructed or maintained, these underground facilities are inspected to ensure that they are installed and operating normally, and to check the deterioration of the concrete in the underground space itself. Specifically, inspectors enter a partitioned small room and inspect the condition of the pipes by visually inspecting them, taking pictures, etc., or using the five human senses. In addition, remote control using wireless communication may be difficult. Here, the area where the pipes are installed is in a very narrow area, and there are no permanently installed sufficient lighting fixtures. In addition, the carbon dioxide concentration is high, and the area is designated as an oxygen deficiency hazard area under the Industrial Safety and Health Act and other laws, making it a place where inspectors are likely to be exposed to danger.
[0003] One of the solutions to the above-mentioned problems is expected to be the use of robots. For example, an autonomous robot (hereinafter, simply referred to as a "snake robot") having a snake-like shape with a long and slender shape like a snake can be used (see Patent Document 1). A snake robot is a robot that imitates a living snake, and can move its joints in various ways like a snake to inspect and search for victims at disaster sites. In addition, a snake robot can freely move its own shape to perform various actions. In particular, a snake robot has a shape that is suitable for entering narrow and complex areas such as disaster sites and plant facilities, and is effective in rescue activities such as searching for victims inside collapsed houses, as well as inspecting pipes in narrow places.
[0004] Here, one of the problems when using a snake-type robot for inspection is the difficulty of controlling (operating) the snake-type robot. For example, a snake-type robot generally has several tens of joints, and it is difficult for a human operator to remotely control all of the joints of the snake-type robot. In this regard, Patent Document 2 discloses a snake-type robot that runs inside a pipe to perform inspections. However, Patent Document 2 assumes that the snake-type robot runs inside a pipe with a diameter approximately equal to that of the snake-type robot itself. By limiting the running range of the snake-type robot in advance as in Patent Document 2, it becomes relatively easy to control the snake-type robot itself, but it is difficult to use it in spaces including places where work is difficult, such as inspections and disaster sites. In addition, in order to facilitate control in underground free sections where the radio wave conditions are poor and communication between the operator and the robot is impossible or unstable, such as underground spaces for building inspections and disaster sites, it is desirable to have an autonomous snake-type robot rather than a remote-operated (remote-operated) robot by a human, but this is not considered in Patent Document 2. In addition, Patent Document 3 discloses a method for controlling the posture of a moving body based on two-dimensional spatial information, but it is assumed that the moving body runs on a flat floor. In the underground space of the building, drainage ditches are laid out vertically and horizontally on the floor to allow groundwater that seeps through the concrete from the ground to flow into a drainage pump, so if the snake-type robot enters the ditches at a large entry angle, it will get stuck. Therefore, the wheels need to enter the ditches at an angle close to perpendicular, but the method of Patent Document 3 is assumed to be on a flat floor, and no consideration is given to posture control for passing through the ditches without getting stuck. [Prior art documents] [Patent documents]
[0005] [Patent Document 1] JP 2019-084665 A [Patent Document 2] JP 2020-507486 A [Patent Document 3] Patent No. 7194955 Summary of the Invention [Problem to be solved by the invention]
[0006] According to one aspect of the present invention, an object is to provide a snake-like robot and a system thereof that can autonomously navigate a floor surface having grooves such as drainage ditches dug vertically and horizontally, enabling inspection in difficult-to-work locations. [Means for solving the problem]
[0007] According to one aspect of the present invention, A moving body that moves autonomously within a predetermined space, A plurality of body portions; A driving means including a multi-link mechanism including a plurality of joints that connect the main body; A storage means, Map information of a two-dimensional map including position information of waypoints along which the moving body moves in two dimensions and inspection points where the moving body stops and performs an inspection operation; and travelable area map information including, when a groove is present in the real environment between the route points in information obtained by superimposing the route points on the map information, the groove being set as a no-entry area information in the map information, the groove being a no-entry area other than a route through which the moving body can pass by facing the groove. A storage means for storing the a self-position estimation means for estimating a self-position of the moving body from the travelable area map information and a current location of the moving body itself; an attitude control means for controlling the attitude of each joint in the left-right direction so that a leading portion of the moving body takes a posture in which the leading portion starts passing directly facing the center of the path on the groove and a trailing portion of the moving body passing between the no-entry areas does not come into contact with the no-entry area; Equipped with the attitude control means excludes some of the plurality of main body parts of the moving body from the targets of attitude control and drive, and performs attitude control and drive on the remaining main body parts; The posture control means provides a moving body characterized in that, when the moving body passes through the path on the groove, it moves straight ahead facing the groove based on the no-entry area information, and performs vertical joint control to prevent the moving body from going off the groove and to prevent its own position recognition from being disturbed even when the moving body descends toward the bottom of the groove when it approaches the groove, thereby allowing the moving body to reach the intermediate point without going off the groove or disturbing its own position recognition. Effect of the Invention
[0008] According to one aspect of the present invention, it is possible to provide a snake-like robot and its system that can autonomously travel on a floor surface that includes a groove such as a drain, enabling inspection in difficult-to-work locations.
[0009] Other objects, features and advantages of the present invention will become apparent from the following detailed description of the preferred embodiments of the present invention taken in conjunction with the accompanying drawings. [Brief description of the drawings]
[0010] [Figure 1] FIG. 1 is a diagram showing an example of the configuration of a robot system according to an embodiment of the present invention. [Diagram 2] FIG. 2 is a diagram showing an example of a robot in which the posture of the robot coincides with a reference posture. [Diagram 3] FIG. 3 is a diagram illustrating an example of a robot when the robot is in a lifting posture. [Figure 4] FIG. 4 is a plan view of the floor surface inside an underground pit of a building to which the present invention is applied. [Diagram 5] FIG. 5 is a side view of an internal beam of a foundation beam of a building to which an embodiment of the present invention is applied. [Figure 6] FIG. 6 is a diagram showing an example of a hardware configuration of a robot control device to which an embodiment of the present invention is applied. [Figure 7] FIG. 7 is a diagram showing an example of a functional configuration of a robot control device to which an embodiment of the present invention is applied. [Figure 8]FIG. 8 is a flowchart showing an example of a process flow in which a robot control device to which an embodiment of the present invention is applied operates a robot. [Figure 9] FIG. 9 is a flowchart showing an example of a process flow in which the robot control device operates the robot. [Figure 10] 10 is a diagram showing an example of a robot operation to which an embodiment of the present invention is applied, showing an example of a moving body map in an underground pit in a system to which an embodiment of the present invention is applied. [Figure 11] 11 is a diagram showing an example of the operation of a robot to which an embodiment of the present invention is applied. In the system to which an embodiment of the present invention is applied, navigation of the leading part of a moving body, a no-entry area, and an entry angle into a groove are shown. [Figure 12] 12 is a diagram showing an example of the robot operation to which an embodiment of the present invention is applied, showing an example of lifting a wheel that loses its posture in a system to which an embodiment of the present invention is applied. [Figure 13] 13 is a diagram showing an example of the robot operation to which an embodiment of the present invention is applied, illustrating a discrepancy between the control timing and the actual timing of switching the contact point. [Figure 14] FIG. 14 is a flowchart showing an example of a process flow in which the robot control device operates the robot. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0011] An embodiment to which the present invention is applied will be described below.
[0012] <Robot system configuration> The configuration of the robot system 1 will be described below.
[0013] 1 is a diagram showing an example of the configuration of a robot system 1 according to an embodiment. The robot system 1 includes a robot 10 and a robot control device 20. Note that in the robot system 1, the robot 10 and the robot control device 20 may be partially or entirely configured as an integrated unit.
[0014] The robot 10 is a snake-like robot including a front part E that is a part corresponding to the snake's head and is equipped with a camera, sensors, etc., a rear end part Z that is a part corresponding to the snake's tail, and a main body part M that is equipped with multiple joints. Note that in the robot 10, the front part E may be configured integrally with the main body part M.
[0015] The leading portion E is supported by the main body portion M and moves in response to the movement of the main body portion M. Note that the leading portion E may be configured to move independently of the movement of the main body portion M, instead of being configured to move in response to the movement of the main body portion M.
[0016] In this example, the leading part E includes one wheel unit W. The wheel unit W is covered with a slippery resin such as plastic so that the leading part E can perform a side-slip motion. The leading part E may not include the wheel unit W. The leading part E may also include two or more wheel units W. The wheel unit W has a pair of wheels. The wheel unit W may include one wheel, or may include three or more wheels, instead of a pair of wheels. In the following, for convenience of explanation, when the wheel of a certain part of the robot 10 is referred to, it refers to the wheel of the wheel unit W of the part. That is, when a certain part of the robot 10 includes one wheel unit W, the number of wheels of the part is two. When a certain part of the robot 10 includes two wheel units W, the number of wheels of the part is four.
[0017] Furthermore, the leading portion E is connected to a first end portion, which is an end portion selected by a user as the leading side among two ends of the main body portion M. The leading portion E and the main body portion M may be connected by any method, for example, by some kind of link member. For convenience of explanation, the end portion opposite the first end portion of the two ends of the main body portion M will be referred to as the second end portion below.
[0018] The camera, sensor, etc. equipped in the head part E are wirelessly connected to the robot control device 20 so as to be able to communicate with the robot control device 20. As a result, the camera, sensor, etc. perform operations based on control signals acquired from the robot control device 20. Here, the wireless communication is performed, for example, according to a communication standard such as Wi-Fi (registered trademark). Note that the camera, sensor, etc. may also be configured to be connected to the robot control device 20 by wired communication performed via a cable according to a standard such as Ethernet (registered trademark) or USB (Universal Serial Bus).
[0019] In this example, the rearmost part Z refers to a part of the robot 10 that is equipped with one wheel unit W. The rearmost part Z may not be configured to have a wheel unit W. The rearmost part Z may also be configured to have two or more wheel units W. The rearmost part Z is supported by the main body part M and moves in accordance with the movement of the main body part M. The rearmost part Z may be configured to move independently of the movement of the main body part M, instead of being configured to move in accordance with the movement of the main body part M.
[0020] Furthermore, the rearmost portion Z is connected to the second end portion of the two ends of the main body portion M. The rearmost portion Z and the main body portion M may be connected by any method, for example, by some kind of link member.
[0021] The main body M is a snake-shaped manipulator (in this embodiment, referred to as a "mobile body having a multi-linked mechanism composed of a plurality of main body parts and a plurality of joints connecting the main body parts" or a "snake-shaped robot") having n first joints J1 and (n-1) second joints J2 as the plurality of joints of the robot 10. The main body M may be configured to have the same number of second joints J2 as the number of first joints J1, or may be configured to have a number of second joints J2 greater than the number of first joints J1. The main body M may be configured to have fewer than (n-1) second joints J2, or may be configured to have more than (n-1) second joints J2.
[0022] Further, the main body M includes a link member L that connects the joints. In the following, as an example, a case where the link member L is a link member that connects between the first joint J1 and the second joint J2 will be described. That is, in this example, the main body M includes the first joint J1 and the second joint J2, and the first joint J1 and the second joint J2 are alternately arranged (included) in the order of the first joint J1, the second joint J2, the first joint J1, the second joint J2, ..., the first joint J1 from the first end to the second end. That is, the main body M includes 2(n-1) link members L. Note that the order in which the first joint J1 and the second joint J2 are arranged in the main body M may be other orders.
[0023] Furthermore, the main body M is provided with (n-1) wheel units W. Note that the main body M may be configured to have fewer than (n-1) wheel units W. The main body M may be configured to have more than (n-1) wheel units W, if it is possible to attach the wheel units W in some way so as not to interfere with the movement of the robot 10. The main body M may be configured to have no wheel units W.
[0024] Further, the main body M is provided with the wheel units W at the second joints J2 such that the rotation axis of the second joint J2 coincides with the axle (rotation axis) of the wheel of the wheel unit W for each of the (n-1) second joints J2. That is, the main body M has 2(n-1) wheels (that is, (n-1) pairs of wheels). Further, the main body M is provided with the (n-1) wheel units W such that, when the posture of the robot 10 coincides with a reference posture described later, all of the 2(n+1) wheels, which are the two wheels of the leading part E, the two wheels of the rearmost part Z, and the 2(n-1) wheels of the main body M, can come into contact with a certain plane. That is, in this case, when the robot 10 is placed on a certain plane, all of the wheels of the robot 10 come into contact with the plane. In addition, of the 2(n+1) wheels, it is desirable that the material of the circumferential surface of each wheel except for the leading part E be a material with a high friction coefficient to prevent sideslip (e.g., rubber, etc.), and it is desirable that the material of the circumferential surface of the leading part E be a material with a low friction coefficient (e.g., plastic resin, etc.) to prevent sideslip when changing direction.
[0025] In the following, as an example, a case will be described in which all of the (n+1) wheel units W, consisting of one wheel unit W at the leading portion E, one wheel unit W at the rearmost portion Z, and the (n-1) wheel units W at the main body M, have the same configuration. Note that the main body M may be configured such that the wheel units W are provided at the second joints J2 such that the rotation axis of the second joint J2 does not coincide with the axle (rotation axis) of the wheel of the wheel unit W for some or all of the (n-1) second joints J2. Also, some or all of the (n+1) wheel units W may have different configurations.
[0026] Here, the first joint J1 is a joint having a rotation axis parallel to the first direction when the posture of the robot 10 and the reference posture are the same. Note that the first joint J1 may be a joint having a rotation axis not parallel to the first direction in this case. Here, in this example, the posture of the robot 10 is represented by the rotation angles of each of a plurality of joints included in the robot 10. Note that the posture of the robot 10 may be configured to be represented by other quantities according to the robot 10.
[0027] The reference posture is a posture that is a reference among postures of the robot 10. In this example, the reference posture is a posture of the robot 10 in which all of the multiple joints (i.e., n first joints J1 and (n-1) second joints J2) included in the robot 10 are aligned on a straight line. More specifically, the reference posture is a posture of the robot 10 in which the positions of the multiple joints are aligned on a straight line. In this example, the position of the first joint J1 is represented by the position of the center of gravity of the first joint J1. In this example, the position of the second joint J2 is represented by the position of the center of gravity of the second joint J2. In the following, for convenience of explanation, when the posture of the robot 10 matches the reference state, a virtual straight line passing through the positions of the multiple joints is referred to as a straight line CL. In addition, in the following, as an example, a case will be described in which the rotation angles of the multiple joints included in the robot 10 are all 0 when the posture of the robot 10 matches the reference posture. That is, in this example, each of the multiple joints is a joint that can rotate up to an upper or lower limit angle in the movable range of the joint with 0 as a reference rotation angle. The position of the first joint J1 may be represented by another position according to the first joint J1. The position of the second joint J2 may be represented by another position according to the second joint J2. The reference posture of the robot 10 may be another posture of the robot 10 instead of the posture.
[0028] The first direction is one of the directions perpendicular to the line CL when the posture of the robot 10 coincides with the reference posture. In the following, as an example, a case will be described in which the first direction coincides with a direction perpendicular to the ground surface (i.e., a normal direction to the ground surface) when the robot 10 in this case is placed on the ground surface. Note that the first direction may not coincide with a direction perpendicular to the ground surface in this case.
[0029] The ground surface is a flat surface on which the robot 10 can be placed. The ground surface is, for example, a flat surface such as an indoor floor surface or an outdoor ground surface, but is not limited thereto and may be another flat surface. As described above, when the posture of the robot 10 coincides with the reference posture, all of the 2(n+1) wheels of the robot 10 can be placed on a certain flat surface. That is, in this case, when the robot 10 is placed on the ground surface, all of the wheels come into contact with the ground surface. In addition, in this case, since all of the wheel portions W in this example have the same configuration, the straight line CL is a straight line parallel to the ground surface.
[0030] Moreover, the second joint J2 is a joint having a rotation axis parallel to the second direction when the posture of the robot 10 and the reference posture are the same. The second direction is a direction perpendicular to the straight line CL and different from the first direction in this case. In the following, as an example, a case where the second direction is a direction perpendicular to both the straight line CL and the first direction in this case will be described. That is, in this case, when the robot 10 is placed on the ground surface, the rotation axis of the second joint J2 becomes parallel to the ground surface.
[0031] Here, the reference posture of the robot 10, the first joint J1, and the second joint J2 will be described with reference to Fig. 2. Fig. 2 is a diagram showing an example of the robot 10 when the posture of the robot 10 matches the reference posture. As shown in Fig. 2, when the posture of the robot 10 matches the reference posture, the positions of the multiple joints (i.e., n first joints J1 and (n-1) second joints J2) included in the robot 10 are aligned on a straight line (a virtual straight line CL shown in Fig. 2).
[0032] In the example shown in Fig. 2, the robot 10 is placed on a plane MN. That is, the plane MN shown in Fig. 2 is an example of the above-mentioned contact plane. In this example, since the posture of the robot 10 and the reference posture are the same, all of the multiple wheels of the robot 10 are in contact with the plane MN.
[0033] Also, in the example shown in FIG. 2, the first direction is the direction indicated by the arrow AN in FIG. 2, which is a direction perpendicular to the plane MN (i.e., the normal direction of the plane MN). Therefore, the rotation axes of the n first joints J1 provided in the robot 10 shown in FIG. 2, which are indicated by the dotted line A1 in FIG. 2, are parallel to that direction. Also, in the example shown in FIG. 2, the second direction is a direction perpendicular to the straight line CL and that direction. Therefore, the rotation axes of the (n-1) second joints J2 provided in the robot 10 shown in FIG. 2, which are indicated by the dotted line A2 in FIG. 2, are parallel to that direction.
[0034] Return to FIG. 1. Each of the n first joints J1 of the robot 10 includes an actuator (not shown). Also, each of the (n-1) second joints J2 of the robot 10 includes an actuator (not shown). The actuators of the n first joints J1 and the actuators of the (n-1) second joints J2 are wirelessly connected to the robot control device 20 so as to be able to communicate with each other. As a result, the actuators of the n first joints J1 and the actuators of the (n-1) second joints J2 operate the robot 10 based on control signals acquired from the robot control device 20. Here, the wireless communication is performed, for example, according to a communication standard such as Wi-Fi (registered trademark). Note that some or all of the actuators of the n first joints J1 may be configured to be connected to the robot control device 20 by wired communication performed according to a standard such as Ethernet (registered trademark) or USB via a cable. In addition, some or all of the actuators provided in each of the (n-1) second joints J2 may be configured to be connected to the robot control device 20 by wired communication via a cable in accordance with a standard such as Ethernet (registered trademark) or USB.
[0035] At least some of the (n+1) wheel units W (i.e., one wheel unit W at the front part E, one wheel unit W at the rear part Z, and the (n-1) wheel units W at the main body part M) of the robot 10 are equipped with actuators (not shown) for rotating each wheel. That is, in this example, the wheels of at least some of the (n+1) wheel units W are active wheels that rotate by an actuator. Also, the wheels of the wheel units W other than the wheel units W having active wheels among the (n+1) wheel units W are passive wheels that do not rotate by an actuator. The (n+1) wheel units W of the robot 10 are composed of at least some of the wheel units W having a pair of active wheels, the wheel units W having a pair of passive wheels, and the wheel units W having both active and passive wheels as a pair of wheels. In the following, as an example, a case will be described in which the (n+1) wheel units W of the robot 10 are configured by a wheel unit W having a pair of active wheels and a wheel unit W having a pair of passive wheels. An actuator of the robot 10 that rotates the active wheels of the robot 10 is wirelessly connected to the robot control device 20 so as to be able to communicate with the robot control device 20. As a result, the actuator rotates the active wheels based on a control signal acquired from the robot control device 20. Here, the wireless communication is performed, for example, according to a communication standard such as Wi-Fi (registered trademark). Note that some or all of the actuators may be configured to be connected to the robot control device 20 by wired communication performed via a cable according to a standard such as Ethernet (registered trademark) or USB.
[0036] In this example, the robot control device 20 is a control device that controls (operates) the robot 10. The robot control device 20 controls the robot 10 so that the robot 10 moves autonomously in accordance with the acquired operation information.
[0037] More specifically, the robot control device 20 sets a control point T on the robot 10, which is a virtual point that moves together with a predetermined part of the parts of the robot 10. The predetermined part is, for example, the center of gravity of a camera, a sensor, etc. equipped on the front part E. Note that the predetermined part may be another part of the robot 10 instead of the center of gravity. The control point T is, for example, a TCP (Tool Center Point). Note that the control point T may be another virtual point instead of the TCP.
[0038] The robot control device 20 also associates a control point coordinate system, which is a virtual three-dimensional orthogonal coordinate system that moves together with the control point T set on the robot 10. The position of the control point T is represented by the relative position of the origin in the control point coordinate system with respect to the origin in a reference coordinate system, which is a reference three-dimensional orthogonal coordinate system. The attitude of the control point T is represented by the relative direction of each coordinate axis in the control point coordinate system with respect to the direction of each coordinate axis in the reference coordinate system. The position of the control point T may be represented by another position according to the control point T. The attitude of the control point T may be represented by another direction according to the control point T.
[0039] The reference coordinate system is an inertial system that is stationary relative to the control point coordinate system. For example, the robot control device 20 specifies, as the reference coordinate system, a three-dimensional coordinate system that coincides with the control point coordinate system at the timing before the robot control device 20 starts moving the robot 10 and at the timing when the robot control device 20 receives an operation to set the reference coordinate system from the user. Alternatively, the robot control device 20 may be configured to specify, as the reference coordinate system, another three-dimensional coordinate system, such as a three-dimensional coordinate system set at a position determined in advance by the user. Alternatively, the robot control device 20 may be configured to specify, as the reference coordinate system, a three-dimensional coordinate system that coincides with the control point coordinate system at another timing.
[0040] The robot control device 20 rotates each of the multiple joints of the robot 10 based on a closed loop system described later so that the speed of the control point T coincides with the target speed indicated by the operation information. In this way, the robot control device 20 can cause the robot 10 to perform an action desired by the user. In other words, the speed of the control point T is a controlled variable in the closed loop system.
[0041] The velocity of the control point T includes a control point translation velocity, which is the velocity at which the position of the control point T translates, and a control point rotation velocity, which is the velocity at which the attitude of the control point T rotates. The translation velocity includes an X-axis translation velocity, which is the velocity at which the position translates along the X-axis in the control point coordinate system, a Y-axis translation velocity, which is the velocity at which the position translates along the Y-axis in the control point coordinate system, and a Z-axis translation velocity, which is the velocity at which the position translates along the Z-axis in the control point coordinate system. The rotation velocity includes an X-axis rotation velocity, which is the velocity at which the attitude rotates around the X-axis, a Y-axis rotation velocity, which is the velocity at which the attitude rotates around the Y-axis, and a Z-axis rotation velocity, which is the velocity at which the attitude rotates around the Z-axis.
[0042] The target velocities include a target translational velocity for matching the control point translational velocities and a target rotational velocity for matching the control point rotational velocities. The target translational velocities include a target X-axis translational velocity for matching the X-axis translational velocities, a target Y-axis translational velocity for matching the Y-axis translational velocities, and a target Z-axis translational velocity for matching the Z-axis translational velocities. The target rotation velocities include a target X-axis rotational velocity for matching the X-axis rotational velocities, a target Y-axis rotational velocity for matching the Y-axis rotational velocities, and a target Z-axis rotational velocity for matching the Z-axis rotational velocities.
[0043] Furthermore, the robot control device 20 can match the rotation angle of each of one or more joints desired by the user among the joints of the robot 10 with the rotation angle desired by the user, while matching the speed of the control point T with the target speed, by controlling the robot 10 based on a closed loop system described below. As a result, the robot control device 20 can operate the robot 10 and match the speed of the control point T with the target speed in a state in which at least a part of the robot 10 is lifted from a plane MN on which at least a part of the wheels of the robot 10 are on the ground. Furthermore, the robot control device 20 can operate the robot 10 and move the parts of the robot 10 that are not lifted from the plane MN without changing the position and posture of the control point T in the state. As a result, the robot control device 20 can cause the robot 10 to perform the operation desired by the user.
[0044] The robot controller 20 may be configured to operate the robot 10 according to an operation program stored in advance in the robot controller 20.
[0045] The robot control device 20 is, for example, an information processing device such as a desktop PC (Personal Computer), a notebook PC, a tablet PC, a multi-function mobile phone terminal (smartphone), a mobile phone terminal, a PDA (Personal Digital Assistant), etc. The robot control device 20 may be other information processing devices instead of these information processing devices.
[0046] The robot control device 20 may be wirelessly connected to a device that can be manually operated from the outside so as to be able to communicate with the device.
[0047] <Description of the floor surface including the drain that the robot passes through> FIG. 4 is a plan view of the floor surface inside an underground pit of a building to which the present invention is applied. The underground pit of this embodiment is divided into compartments 8 by foundation beams 6. Between the compartments 8, through holes such as human access are provided. Within the compartments 8, drainage channels 9 are provided, with a width of, for example, about 150 mm and a depth of, for example, about 30 to 50 mm. Here, the width of the drainage channels 9 is configured to be longer than the length of one of the multiple main bodies of the mobile body of this embodiment. In addition, a slight slope is provided within the compartments 8, and the groundwater and rainwater that seeps through the concrete are collected in the drainage channels 9 within each compartment and are structured to flow toward an external drain pipe.
[0048] <Hardware configuration of the robot control device> The hardware configuration of the robot control device 20 will be described below with reference to Fig. 6. Fig. 6 is a diagram showing an example of the hardware configuration of the robot control device 20.
[0049] The robot control device 20 includes, for example, a processor or CPU (Central Processing Unit) 21, a storage unit 22, and a communication unit 24. These components are connected to each other via a bus BS so that they can communicate with each other. The robot control device 20 also communicates with the robot 10 via the communication unit 24.
[0050] The CPU 21 executes various programs stored in the storage unit 22. The storage unit 22 includes, for example, a hard disk drive (HDD), a solid state drive (SSD), an electrically erasable programmable read-only memory (EEPROM), a read-only memory (ROM), and a random access memory (RAM). The storage unit 22 may be an external storage device connected via a digital input / output port such as a USB instead of being built into the robot control device 20. The storage unit 22 stores various information and various programs processed by the robot control device 20. It may also store information about the path over steps that the robot passes through. The communication unit 24 includes, for example, a digital input / output port such as a USB, an Ethernet port, and the like.
[0051] <Functional configuration of the robot control device> The functional configuration of the robot control device 20 will be described below with reference to Fig. 7. A software functional configuration 20 and a data configuration 22 in Fig. 7 show an example of a functional configuration applicable to the hardware configuration of the robot control device 20 in Fig. 6. The multi-connected mobile robot 10 is equipped with a LiDAR (Light Detection and Ranging, Laser Imaging Detection and Ranging) 11 and an inspection camera 12.
[0052] The robot control device 20 includes a supervisory unit 22, a self-position estimating unit 24, and a robot control unit 26. It may further include an imaging unit 28. The robot control device 20 also includes a storage unit 22 that stores any data.
[0053] The storage unit 22 stores data related to an operation instruction list 221, an obstacle map 222, a no-entry area map 223, a ditch map 224, and an inspection image group 225. Note that, in this embodiment, the storage unit 22 stores all the data, but in another embodiment, a plurality of storage units may be provided and configured to store any data.
[0054] The control unit 22 controls the overall operation of the self-position estimation unit 24, the robot control unit 26, and the photographing unit 28 based on the robot operation command recorded in the operation instruction list 221. The driving route information and operation instruction information such as imaging at a predetermined position input by the user are given as divided instructions to the self-position estimation unit 24, the robot control unit 26, and the photographing unit 28 by the control unit. When the robot is operating, the control unit 22 constantly collects and monitors information from the self-position estimation unit 24, the robot control unit 26, and the photographing unit 28, and instructs each part to perform or wait for an operation so that the operation is in accordance with the operation instruction information. The control unit executes the pedestrian passage unit, the navigation unit, and the photographing unit according to the operation instruction list created by the user in advance. In this embodiment, the self-position estimation unit 24 performs self-position estimation based on the environmental map and the point cloud of the LiDAR using any method. The estimated self-position is transmitted to the navigation unit 261 and the planar movement unit 262.
[0055] The environmental maps (obstacle map 222, ditch map 224, etc.) are created based on architectural drawings of the underground pit. Then, the environmental maps are created manually in advance based on two-dimensional drawings and given to the robot. As a concrete example, when moving along a route as shown by the arrow in Fig. 10(a), the obstacle map for matching with the obstacle point cloud shows areas where obstacles exist in black and areas where no obstacles exist in white, as shown in Fig. 10(b), while the ditch map shows areas that are ditches in black and areas that are not ditches in white, as shown in Fig. 10(c).
[0056] The robot control unit 26 controls the entire robot control device 20 in accordance with instructions given from the management unit 22. The control unit 26 includes a navigation unit 261 and a planar movement unit 262. When it is necessary to pass through a human passage, the control unit 26 may also include a human passage passage unit 263. These functional units included in the control unit 26 are realized, for example, by the CPU 21 in FIG. 6 executing various programs stored in the storage unit 22. Also, some or all of the functional units may be hardware functional units such as LSI (Large Scale Integration) and ASIC (Application Specific Integrated Circuit).
[0057] The navigation unit 261 calculates the leading speed of the robot based on the target point and the target leading position and posture given by the control unit 22. A speed command value for the leading part of the robot is transmitted to the planar movement unit. The navigation unit 261 sequentially calculates the leading speed (translational speed on the XY axes and rotational speed on the Z axis) that the robot should achieve in order to reach the target posture from the current posture according to the leading position and posture given by the control unit 22 and the current position and posture of the robot acquired before and during the robot's running, and transmits this to the robot as a running speed and angle instruction.
[0058] In an environment where a groove exists, entering an area on a groove, except when crossing a groove, poses the risk of getting stuck, so it is necessary to avoid entering areas on grooves except for those that are part of a route. Therefore, in this system, a no-entry area map is prepared, and areas where obstacles exist and areas on grooves that are not part of a route are designated as no-entry areas. This map is used to plan a route, and a route is generated that avoids the no-entry areas. In this case, a route is generated in which the leading edge of the robot approaches the groove at a perpendicular angle, as shown in Figure 11, so that the leading edge of the robot does not approach the groove at a large angle. As a specific example, when moving along a route as shown by the arrow in the assumed environment and route shown in Figure 10(a), a no-entry area map like that shown in Figure 10(d) is prepared. Here, the no-entry areas are shown in black, and the areas that can be moved are shown in white.
[0059] The planar movement unit 262 is a processing unit that calculates each joint angle of the robot so that when the robot moves autonomously on a flat surface (such as a floor surface), the leading part of the robot moves according to a predetermined target, and the trailing parts move to avoid no-entry areas, joint movement limits, and self-collisions. The planar movement unit 262 transmits the joint velocities during planar movement to the multi-linked mobile robot.
[0060] The planar movement unit 262 is a processing unit required for controlling the robot so that the robot can autonomously travel on a plane including a groove while avoiding getting stuck.
[0061] The pedestrian entrance passage unit 263 is a processing unit required for controlling the robot when the robot passes through a pedestrian entrance. The pedestrian entrance passage unit 263 transmits the joint angles when passing through the pedestrian entrance to the multi-linked mobile robot.
[0062] In this embodiment, we consider a kinematic model of a multi-linked mobile robot, assuming that the wheels do not slip. In this control, the main task is to realize the target translation and rotation speed of the head, and the remaining redundancy is used to realize the subtasks of avoiding no-entry areas, avoiding joint motion limits, and avoiding self-collision. Making the wheel entry angle into the groove perpendicular is achieved by avoiding the no-entry areas as shown in Figure 11.
[0063] A unique number is assigned to the arrangement of grounded and non-grounded wheels, and is called a mode. On a plane without grooves, the mode can be freely switched by lifting the wheels. However, when grooves exist, the wheels on the grooves are not grounded, so the mode depends on the environment. Therefore, a mode that makes the wheels on the grooves not grounded is selected. At this time, the wheels floating on the grooves do not need to be lifted because they do not have wheel constraints. However, in actual control, after the wheel floating on the grooves crosses the groove and touches the plane, until the next mode switching, the wheel has wheel constraint, but is treated as not having wheel constraint in terms of control. Therefore, to avoid this, the wheels on the grooves are lifted. However, low-friction passive wheels are not lifted because they do not always have wheel constraints. When lifting a wheel, if the wheel that serves as the fulcrum is on the groove, the wheel cannot serve as the fulcrum and may lose its posture, causing it to get stuck or the wheel to be lifted to the ground. Therefore, it is necessary to prevent the selection of a mode that lifts such wheels. Assuming that the wheel on the groove is lifted as described above, a mode for lifting the wheel on the groove closest to the end is not selected, as shown in Fig. 12. In this embodiment, the wheel on the groove is identified from the estimated self-position and the groove map. However, since the wheel enters the groove at an angle close to perpendicular, when the center of the axle is on the groove, both the left and right wheels are considered to be on the groove.
[0064] In this example, we proposed a ditch-crossing control method for autonomous inspection inside an underground pit with a drainage ditch, and confirmed that this control method enables the robot to move autonomously across the drainage ditch and prevent posture loss by mode restriction.In the future, we will improve the accuracy of self-position estimation and consider a function to automatically determine the position to pass through the ditch.
[0065] <Processing by the robot controller to operate the robot> The process of the robot control device operating the robot will be described below. Note that in the description of this embodiment, the robot control device may be the subject of operation, or the robot may be the subject of operation (autonomous control), but it should be noted that a person skilled in the art can freely change the design to determine which is the subject of operation.
[0066] <Control design for crossing drains> We will explain the control design for crossing drains. We will propose a method for controlling the position and attitude of the front end to cross drains in underground pits.
[0067] <Model> A unique number σ is assigned to the arrangement of grounded and non-grounded wheels, and this number is called a mode. Let the number of links of the robot be n and the number of active wheels be n. w , the number of non-grounded wheels in mode σ is m σ The number of active wheels that are not grounded in mode σ is a σ , the i-th yaw joint angle is
number
number
number
number
number
number
[0068] <Control Input> The main task is to track the leading edge, and the remaining redundancy is used to achieve the subtasks. The evaluation function for the subtasks is defined as V(q), and control is performed so that V becomes small. However,
number
number
number
number
number
number
number
number
[0069] <Subtask> The subtasks are to avoid forbidden areas, to avoid joint movement limits, and to avoid self-collision. o (q), V l (q), V s (q) and the weight is a o , a l , a s Then, the evaluation function for the subtasks can be expressed as follows:
number
[0070] <Avoiding no-entry areas> An evaluation function is set to avoid the forbidden area. The positions of all yaw joints and the center of the wheel axis on the xy plane are assigned numbers from 1 to 2n, and the shortest distance between the i-th position and the forbidden area is defined as d i Let .d i If the threshold value of is d0, then V o (q) can be expressed as follows:
number
[0071] <Avoiding joint mobility limits> An evaluation function is set to prevent the angle of the yaw joint from exceeding the movement limit. The threshold for avoiding the movement limit of the joint angle is
number
number
[0072] <Self-collision avoidance> An evaluation function is set to avoid self-collision. The number of links that do not cause self-collision is set to n. s Let 0 be the position of the head on the xy plane, and numbers from 1 to n be assigned to the positions of the center of the wheel axle on the xy plane. Let d be the distance between the i-th position and the j-th position. ij Let .d ij The distance threshold is d 00 Then, V s (q) can be expressed as follows:
number
[0073] <Mode selection> In this embodiment, the mode is randomly changed among modes that satisfy the restrictions for crossing a groove described below in the section on mode restrictions due to non-grounding wheels on a groove and mode restrictions due to wheel lifting.
[0074] <Mode restriction due to non-grounding wheels on grooves> On a flat surface without grooves, the mode can be freely switched by lifting the wheel. However, when grooves exist, the wheels on the grooves are not grounded, so the mode depends on the environment. Therefore, the selectable modes are limited to those in which the wheels on the grooves are not grounded.
[0075] <Mode restriction due to wheel lift> When lifting a wheel, if the wheel that serves as the fulcrum is on a groove, the wheel will not be able to serve as a fulcrum and may lose its balance, creating a risk of getting stuck or the wheel being lifted may touch the ground. For this reason, restrictions are placed on the selection of modes that would lift such wheels.
[0076] <Discrepancy between the control timing and the actual timing of ground point switching> Normally, wheels that float on the groove do not need to be lifted because there is no wheel constraint. However, in actual control, after a wheel that floats on the groove crosses the groove and touches the flat surface, the wheel has wheel constraint from the time it crosses the groove to the time the next mode is switched, but in control it is treated as if there is no wheel constraint (Figure 13: Mismatch between control and actual contact point switching timing). Therefore, to avoid this, wheels that are treated as not on the ground are lifted. However, low-friction wheels are not lifted because they are always free of wheel constraint. On the other hand, from the time when the wheel that floats on the groove enters the groove until the next mode switching, the wheel does not have a wheel constraint, but is treated as having a wheel constraint in terms of control. In this case, the redundancy of the wheel on the groove cannot be used, but the main task and subtask are accomplished while satisfying the wheel constraint on the groove.
[0077] <Detecting wheels on grooves> The wheels on the groove are identified from the estimated self-position and the groove map. However, since the wheels enter the groove at an angle close to perpendicular, if the center of the wheel axle is on the groove, both the left and right wheels are considered to be on the groove.
[0078] As an example, the robot of this embodiment is controlled to pass through all inspection points included in the two-dimensional spatial information, and if a drain is present between the inspection points, to pass through the inspection route without getting stuck in the drain. A travel route is set for all inspection points in the two-dimensional information, taking into consideration that the head and the following part of the moving body itself do not interfere with each other, and that just before the drain, the moving body is in a posture that faces the drain directly and starts passing through. The robot is controlled to avoid obstacles included in the two-dimensional spatial information, and at the inspection points, it operates to acquire environmental information around the inspection points.
[0079] Hereinafter, a process in which the robot controller 20 operates the robot 10 will be described with reference to Fig. 8. Fig. 8 is a flow chart showing an example of a process flow in which the robot controller 20 operates the robot 10.
[0080] At S8010, the robot is placed into the inspection entrance. In S8020, the moving object estimates its own position. Any method may be used to estimate the self-position.
[0081] In S8030, the room is inspected. Here, one or more locations (waypoints) are inspected according to the inspection location information specified in advance by the instructor. When inspecting multiple locations, the inspection order and inspection route are specified in advance by the instructor. During the operation of S8030, the robot's self-location estimation and two-dimensional posture control based on the self-location estimation result are always performed. Self-location estimation is performed by matching information on the robot's self-location, planned movement location, and the posture to be taken at the movement destination with LiDAR information and a pre-map. When there are multiple specified locations, if there are any obstacles or grooves on the way, the sensor detects them, and the robot moves to the next specified location while avoiding the obstacles and grooves as appropriate. Obstacle avoidance control is performed in the inspection control mode based on two-dimensional information. When a groove such as a drain specified in the inspection location information is reached, the robot transitions to the drain passing operation of S8030.
[0082] In S8040, the robot passes through a ditch such as a drain. When passing through a ditch, the robot starts passing through the ditch with the front end facing the ditch, using the travel route information that is a travel route connecting waypoints among ditches such as drains whose positions have been specified in advance, and that specifies as prohibited areas any ditch other than the route through which the robot itself can pass while facing the ditch, and the information on the line segment connecting the front and rear wheels of the robot that has reached the ditch, among the multiple wheels of the robot, and passes through by sequentially controlling the passing posture so that the front and rear parts of the robot do not come into contact with the prohibited area. After the robot passes through a ditch such as a drain by the operation of S8040, it continues traveling toward the next waypoint. If a ditch such as a drain is present between the waypoints, the robot continues traveling while performing the operation of passing through the ditch in S8040 until it has reached all waypoints.
[0083] In S8050, the robot returns. The return route is specified by the instructor before the start of the inspection, just like in S8030 and S8040, and the robot operates in the same way as in S8030 and S8040.
[0084] FIG. 9 is a flowchart showing an example of a process flow in which the robot control device operates the robot.
[0085] In S10010, a map containing points to be measured by the robot is selected or input from an external source. The robot performs processing to acquire environmental information using any environmental recognition means such as an infrared sensor or LiDAR (Light Detection and Ranging, Laser Imaging Detection and Ranging).
[0086] In S10020, one or more measurement points (WayPoints) are input on the map. For example, data may be read from two-dimensional information such as design drawings, and based on the measurement points arbitrarily designated by the user, the robot may automatically calculate a route passing through the multiple measurement points, or the user may arbitrarily designate the measurement points. In addition, any points to be passed between one measurement point and another (via points) are set as necessary. One example of the reason for setting via points is to allow the robot to move smoothly by avoiding places where it is difficult to travel, such as obstacles and ditches. In this embodiment, the route is set so that the robot passes over a drainage ditch from the travel start point and heads toward the waypoint at the end of the drainage ditch.
[0087] In S10030, an environment recognition means such as an infrared sensor is used to search the area around the robot. This allows for self-location estimation and environmental map creation. Simultaneous Localization and Mapping (SLAM) may be used here. SLAM is a general term for technology that simultaneously estimates the self-location of a moving object and creates an environmental map. By utilizing SLAM, an environmental map can be created for a moving object in an unknown environment. The robot uses the constructed map information to avoid obstacles and perform specific tasks.
[0088] In S10040, the robot is moved to the measurement point based on the created environmental map. When the head of the robot reaches the measurement point, the robot stops moving. When the robot moves, it is controlled to avoid obstacles.
[0089] When the S10050 robot reaches a measurement point, it inspects the room. For example, the robot uses the imaging unit attached to its head to take pictures of the area around the measurement point and obtain information from thermometers, gas leak sensors, etc.
[0090] In S10060, it is determined whether all the measurement point data has been acquired. If there is a next measurement point, the robot moves to the next measurement point. If all the measurement points have been visited, the robot returns.
[0091] In S10070, the robot returns. When returning, it may return along the route it has taken so far. If it is possible to turn on the spot, it may return by turning.
[0092] In S10080, the information acquired in the inspected room is collected.
[0093] <Processing for the robot to pass through a groove on the path> As shown in Fig. 14, in this embodiment, a method of operation is described in which a path that the robot should pass through a ditch such as a drain is determined in advance and the robot accurately follows the path. In this embodiment, this is also called a passing control mode. In this embodiment, in addition to accurately following the path, the speed may also be adjusted so that the target angle and angular velocity do not exceed the hardware constraints.
[0094] In S14010, two-dimensional map information is stored, which includes information on waypoints where the moving body moves in two dimensions and inspection points where the moving body stops and performs inspection operations, and drivable area map information that includes, in information in which the waypoints are superimposed on the map information, grooves that exist in the real environment between the waypoints and that are not on the route that the moving body can pass through when facing directly, as no-entry area information in the map information.
[0095] In S14020, the self-position of the moving object is estimated from the travelable area map information and the current position of the moving object itself.
[0096] In S14030, the leading edge of the moving body takes a posture in which it faces directly over the center of the path on the groove and starts passing through.
[0097] In S14040, the posture of each joint in the left-right direction is controlled so that the trailing part of the moving object passing between the no-entry areas does not come into contact with the no-entry area.
[0098] In S14050, some of the multiple main body parts of the moving body are excluded from the posture control and drive, and the posture control and drive are performed by the remaining main body parts.
[0099] In S14060, when a moving body passes through a route on a ditch, the moving body moves straight ahead facing the ditch based on the no-entry area information, and vertical joint control is performed to prevent the moving body from going off the track and having its own position recognition disturbed even when the moving body descends toward the bottom of the ditch when it approaches the ditch, so that the moving body reaches the intermediate point without going off the track into the ditch or having its own position recognition disturbed.
[0100] Return to S14020 and control is performed until the entire main body portion has passed through the groove. For convenience of explanation, the processes from S14020 to S14060 have been described as being controlled in order, but these processes may be controlled in a different order, or any number of processes may be performed in parallel.
[0101] The device may also be configured to overlay map information and no-entry area information to identify drivable areas and perform route calculations to prevent the vehicle from skidding or losing control of its own position due to driving straight into a ditch or descending into the ditch.
[0102] In addition, a driving route is set along a two-dimensional map, taking into account attitude control instruction information that allows the leading and trailing parts of the moving body to pass through all inspection points without interference, and the moving body may be configured to acquire environmental information about the surroundings of each inspection point at each inspection point.
[0103] Also, if it is impossible to reach the next waypoint even after a certain time has passed, the vehicle may be configured to generate a return route and return. Each time a waypoint is reached, a mismatch between the self-location estimation and map information is detected, and if it is impossible to reach the next waypoint, the vehicle may be configured to generate a return route and return.
[0104] In addition, if the groove detection means detects a groove that does not exist in the map information while traveling on a driving route, it may be configured to determine whether it is possible to pass over the groove based on the depth information obtained by the groove detection means and the information on the total length and weight of the mobile body, and if it is not possible to pass over the groove, to perform a route calculation that sets the driving route to the next target point or the return route as the next inspection point.
[0105] In this embodiment, only a single ditch crossing has been described. In an actual underground pit, it is expected that multiple pedestrian entrances will be crossed at the same time near the drainage ditch junction, such as a T-junction or crossroads. In this case, it is sufficient to combine the single ditch crossing method described in this embodiment from multiple perspectives.
[0106] As an additional example, when creating drivable map information, a kettle shed and a ditch junction are designated as no-entry areas, and the ditch area is designated as a high cost within a passable range, and a route is created from a global cost map. In this case, a route that is nearly perpendicular to the ditch may be generated to achieve low cost, and then, the ditch other than the route may be designated as a no-entry area. Here, the global cost map may be stored in any storage means. In addition, a predetermined threshold may be set as the criteria for high cost and low cost, and areas higher than the threshold may be designated as high cost and areas lower than the threshold may be designated as low cost.
[0107] Although the embodiments of the present invention have been described above, various alternatives, modifications, and variations are possible for those skilled in the art based on the above description, and the present invention includes the above-mentioned various alternatives, modifications, and variations without departing from the spirit of the present invention.
Claims
1. A moving body that autonomously moves across a groove in a predetermined space having a groove on the floor, A plurality of body portions; A driving means including a multi-link mechanism including a plurality of joints that connect the main body; A storage means, Map information of a two-dimensional map including position information of waypoints along which the moving body moves in two dimensions and inspection points where the moving body stops and performs an inspection operation; and travelable area map information including, when a groove is present in the real environment between the route points in information obtained by superimposing the route points on the map information, the groove being set as a no-entry area information in the map information, the groove being a no-entry area other than a route through which the moving body can pass by facing the groove. A storage means for storing the a self-position estimation means for estimating a self-position of the moving body from the travelable area map information and a current location of the moving body itself; an attitude control means for controlling the attitude of each joint in the left-right direction so that a leading portion of the moving body takes a posture in which the leading portion starts passing directly facing the center of the path on the groove, and a trailing portion of the moving body passing between the no-entry areas does not come into contact with the no-entry area; Equipped with the attitude control means excludes some of the plurality of main body parts of the moving body from the targets of attitude control and drive, and performs attitude control and drive on the remaining main body parts; The posture control means controls the joints in the vertical direction when the moving body passes through the path on the groove, while facing the groove and moving straight ahead, to prevent the moving body from going off the track or having its own position recognition disturbed, even when the moving body descends toward the bottom of the groove when it approaches the groove, and the moving body reaches the intermediate point without going off the track into the groove or having its own position recognition disturbed.
2. The mobile body according to claim 1, characterized in that the map information and the no-entry area information are overlaid to identify a drivable area, and a route is calculated to prevent the mobile body from going off the road and from losing control of its own position due to going straight ahead toward the groove and descending toward the groove.
3. The mobile body according to claim 1, characterized in that a driving route is set along the two-dimensional map, taking into account attitude control instruction information that enables the leading portion and trailing portion of the mobile body to pass through all inspection points without interference with each other, and the mobile body acquires environmental information around each inspection point at each inspection point.
4. 2. The mobile body according to claim 1, wherein if it is not possible to reach the next waypoint even after a certain period of time has elapsed, a return route is generated and the mobile body returns.
5. The mobile body according to claim 1, characterized in that when a groove that does not exist in the map information is detected by a groove detection means while traveling on the travel route, a determination is made as to whether or not it is possible to pass over the groove based on the depth information obtained by the groove detection means and information on the total length and weight of the mobile body, and if it is impossible to pass over the groove, a route calculation is performed in which the travel route to the next destination point or the return route is set as the next inspection point.
6. In creating the drivable map information, The kettle pit and ditch junction are designated as no-entry areas. The moving body according to claim 1, characterized in that the groove area is designated as a high cost within a passable range, and a route is created from a global cost map. In this case, a route nearly perpendicular to the groove is generated so as to reduce the cost, and then the grooves other than the route are designated as a forbidden area.
7. A program for causing a processor to operate a moving object that autonomously moves across a groove in a predetermined space having a groove in the floor, A driving means including a multi-link mechanism including a plurality of joints that connect the main body; A storage means, Map information of a two-dimensional map including position information of waypoints along which the moving body moves in two dimensions and inspection points where the moving body stops and performs an inspection operation; and travelable area map information including, when a groove is present in the real environment between the route points in information obtained by superimposing the route points on the map information, the groove being set as a no-entry area information in the map information, the groove being a no-entry area other than a route through which the moving body can pass by facing the groove. A storage means for storing the a self-position estimation means for estimating a self-position of the moving body from the travelable area map information and a current location of the moving body itself; an attitude control means for controlling the attitude of each joint in the left-right direction so that a leading portion of the moving body takes a posture in which the leading portion starts passing directly facing the center of the path on the groove, and a trailing portion of the moving body passing between the no-entry areas does not come into contact with the no-entry area; Equipped with the attitude control means excludes some of the plurality of main body parts of the moving body from the targets of attitude control and drive, and performs attitude control and drive on the remaining main body parts; The posture control means, when the moving body passes through the path on the groove, moves straight ahead facing the groove based on the no-entry area information, and performs vertical joint control to prevent the moving body from going off the groove and to prevent its own position recognition from being disturbed even when the moving body descends toward the bottom of the groove when it approaches the groove, thereby reaching the intermediate point without going off the groove or having its own position recognition disturbed.
Citation Information
Patent Citations
Multifunctional serpentiform robot
CN102528805A
Stairs traveling vehicle
JP1996030326A
Movement device and movement system
JP2016218504A
Parking lot management system
JP2020077149A
Autonomous robot, control method for autonomous robot, and inspection system using autonomous robot
JP7194955B1
Cited By
Mobile body that overcomes obstacles, mobile body control method, mobile body control system, and mobile body control program
JP7795179B1
