The present invention relates to a travel teaching recording method for an autonomous traveling body, an autonomous traveling body that performs the travel teaching recording method, and a non-transitory computer-readable recording medium that stores a program that causes a computer to execute the travel teaching recording method.
Conventionally, there is known an autonomous traveling body that autonomously travels according to path planning from a travel start position to a travel end position. As an example, an autonomous travel type floor cleaning machine reproduces a travel path and cleaning conditions taught by an operator's operation, so as to autonomously travel along the taught travel path while reproducing cleaning according to the taught cleaning conditions.
In a teaching travel, an operator operates the autonomous traveling body to travel along a travel path while teaching information such as position, speed, and the like to the autonomous traveling body. There are two types of autonomous reproduction travels. One is a copy travel in which the travel path taught by the operator in advance is autonomously traveled as it is. The other is filling travel in which a control unit determines an autonomous travel path within an outer periphery taught by direct teaching by the operator in advance, and the autonomous travel path is autonomously traveled.
In the teaching travel, the operator continuously operates a moving body without stopping the teaching operation. An autonomous lawn mower robot described in Japanese Patent No. 6679506 has a function to stop recording data when an unintentional action occurs during the teaching travel, as described in claim 14 and paragraph 0005.
If there is an obstacle on a route during the teaching travel, the operator stops operation of the autonomous moving body and removes the obstacle from the route. In this case, although the travel of the autonomous moving body is stopped, the teaching continues. As a result, in the copy travel for example, an unnecessary wait time (i.e., a time for removing the obstacle in this case) is reproduced, resulting in deterioration of work efficiency. Otherwise, the teaching travel needs to be performed again.
Conventionally, the operator stops travel of the autonomous moving body, and then press a record stop button. In this way, in the autonomous reproduction travel, position and speed are continuous before and after the stop. However, if the operator presses the record stop button while the autonomous moving body is traveling, the autonomous moving body continues to travel after the record stop button is pressed. As a result, when joining the record before stopping recording and the record after resuming recording, position and speed become discontinuous in the autonomous reproduction travel.
A travel teaching recording method for an autonomous traveling body according to a preferred embodiment of the present invention enables smooth travel in autonomous reproduction travel when the autonomous traveling body travels based on a record before stopping recording and a record after resuming recording in teaching travel.
Hereinafter, a plurality of aspects are described and can be arbitrarily combined as necessary or desired.
A travel teaching recording method for an autonomous traveling body according to an aspect of a preferred embodiment of the present invention is used for an autonomous traveling body including a body, a storage to store environment information and body position information when the body performs teaching travel, and a pause switch to stop or resume the teaching travel of the body and the recording. The travel teaching recording method includes detecting whether or not an operator has performed a stopping operation of the pause switch, stopping traveling of the autonomous traveling body and controlling timing to stop recording in the storage if the stopping operation of the pause switch is detected, detecting whether or not the operator has performed a resuming operation of the pause switch, starting traveling of the autonomous traveling body and controlling timing to resume the recording in the storage if the resuming operation of the pause switch is detected, and joining the record before stopping recording and the record after resuming recording so as to store the joined record in the storage.
In this method, when the operator performs the stopping operation of the pause switch in the teaching travel, stopping traveling of the autonomous traveling body and stopping recording in the storage are performed. In addition, when the operator performs the resuming operation of the pause switch in the teaching travel, starting of travel of the autonomous traveling body and starting of recording in the storage are performed. As for the record, the record before stopping recording and the record after resuming recording are joined. Therefore, in the reproduction travel, the autonomous traveling body can travel using the joined record of the record before stopping recording and the record after stopping recording. In other words, the problem that position and speed of the autonomous moving body become discontinuous in the reproduction travel does not occur.
As a result, in the autonomous reproduction travel, the autonomous traveling body can travel smoothly when traveling based on the record before stopping recording and the record after resuming recording in the teaching travel. Therefore, it is possible to stop the autonomous traveling body during the teaching travel, so as to perform removal of an obstacle on a path or other work. In addition, during the teaching travel, the operator can wait other person or object to pass, or can leave for checking a route or resting.
The timing to stop recording may be a predetermined time after stopping traveling of the autonomous traveling body. In this method, recording is stopped at a predetermined time after stopping travel, i.e., after a travelling speed of the autonomous traveling body becomes substantially zero, and hence, a state and operation of the autonomous traveling body after stopping travel, i.e., a situation where the autonomous traveling body stays at the position without doing anything, are recorded. Therefore, in the reproduction travel, the autonomous traveling body does not start travelling immediately after a sudden stop. In other words, in the reproduction travel, travel and operation of the autonomous traveling body are stable.
The timing to stop recording may be simultaneous with stopping traveling of the autonomous traveling body. In this method, as recording is stopped simultaneously with stopping travel, a stop period of the autonomous traveling body in the reproduction travel can be reduced or minimized.
This method may further include editing stored information after the operator's stopping operation of the pause switch until stopping recording. In this method, for example, by editing the stored information so as to reduce deceleration after the operator's stopping operation of the pause switch until stopping recording, the autonomous traveling body can gently stop in pausing.
Note that in the above editing, it may be possible to edit either or both before and after the period after the stopping operation of the pause switch until stopping recording.
The timing to resume recording may be simultaneous with starting traveling of the autonomous traveling body. In this method, a stop state before starting traveling of the autonomous traveling body is not recorded. Therefore, in the reproduction travel, zero speed place can be reduced.
The timing to resume recording may be a predetermined time after starting traveling of the autonomous traveling body. In this method, in the teaching travel, decelerating operation and accelerating operation of the autonomous traveling body are not recorded, for example. Therefore, in the reproduction travel, the autonomous traveling body does not perform the operations corresponding to acceleration and deceleration in the teaching travel.
This method may further include creating information to join information of a recording stop position and information of a recording resume position. In this method, information can be edited so that position, speed, and device operation can be smoothly joined between when stopping recording and when resuming recording.
Note that in the above editing, it may be possible to edit either or both before and after the period after the recording stop position until the recording resume position.
The timing to stop recording may be simultaneous with the operator's stopping operation of the pause switch. In this method, in the teaching travel, decelerating operation of the autonomous traveling body is not recorded, for example. Therefore, in the reproduction travel, the autonomous traveling body does not perform the operation corresponding to the decelerating in the teaching travel.
The timing to resume recording may be simultaneous with the operator's resuming operation of the pause switch. In this method, the stop state before starting traveling of the autonomous traveling body is recorded. Therefore, in the reproduction travel, the autonomous traveling body does not start travelling immediately after a sudden stop after a pause. In other words, the autonomous traveling body securely stops traveling.
A travel teaching recording method for an autonomous traveling body according to another aspect of a preferred embodiment of the present invention is used for an autonomous traveling body including a body, a storage to store environment information and body position information when the body performs teaching travel, and a record pause switch to stop or resume recording of the body and to be enabled only during stop of the body. The travel teaching recording method includes detecting whether or not an operator has performed a stopping operation of the record pause switch, controlling timing to stop recording in the storage if the stopping operation of the record pause switch is detected, detecting whether or not the operator has performed a resuming operation of the record pause switch, controlling timing to resume recording in the storage if the resuming operation of the record pause switch is detected, and joining the record before stopping recording and the record after resuming recording so as to store the joined record in the storage unit.
In this method, the record pause switch is disabled during teaching and traveling, and it becomes enabled when the autonomous traveling body stops teaching and traveling. The operator performs the stopping operation of the record pause switch during stop of the autonomous traveling body, and after that performs the resuming operation of the record pause switch. When the stopping operation of the record pause switch is performed, recording is promptly stopped. When the resuming operation of the record pause switch is performed, recording is promptly resumed. The record pause switch does not function while the autonomous traveling body is traveling, and the problem that position and speed of the autonomous moving body become discontinuous in the reproduction travel does not occur.
An autonomous traveling body according to still another aspect of a preferred embodiment of the present invention includes a body, a storage to store environment information and body position information when the body performs teaching travel, a pause switch to stop and resume the teaching travel of the body and recording, and a processor configured or programmed to detect whether or not an operator has performed a stopping operation of the pause switch, stop traveling of the autonomous traveling body and control timing to stop recording in the storage if the stopping operation of the pause switch is detected, detect whether or not the operator has performed a resuming operation of the pause switch, start traveling of the autonomous traveling body and control timing to start the recording in the storage if the resuming operation of the pause switch is detected, and joining the record before stopping recording and the record after resuming recording so as to store the joined record in the storage unit.
A non-transitory computer-readable recording medium according to still another aspect of a preferred embodiment of the present invention stores a program that causes a computer to perform a travel teaching recording method for an autonomous traveling body, including a body, a storage to store environment information and body position information when the body performs teaching travel, and a pause switch to stop and resume the teaching travel of the body and recording. The program causes the computer to perform detecting whether or not an operator has performed a stopping operation of the pause switch, stopping traveling of the autonomous traveling body and controlling timing to stop recording in the storage if the stopping operation of the pause switch is detected, detecting whether or not the operator has performed a resuming operation of the pause switch, starting traveling of the autonomous traveling body and controlling timing to start the recording in the storage if the resuming operation of the pause switch is detected, and joining the record before stopping recording and the record after resuming recording so as to store the joined record in the storage.
In travel teaching recording methods for autonomous traveling bodies according to preferred embodiments of the present invention, the autonomous traveling bodies each can smoothly travel in the reproduction travel when traveling based on a record before stopping recording and a record after restarting recording in teaching travel.
The above and other elements, features, steps, characteristics and advantages of the present invention will become more apparent from the following detailed description of the preferred embodiments with reference to the attached drawings.
With reference to
The cleaning machine 100 includes a travel unit 1. The travel unit 1 is a device that causes the cleaning machine 100 to travel. The travel unit 1 includes a main body B that is a main body of the cleaning machine 100. The travel unit 1 includes a travel motor 11 and a main wheel 13 connected to an output rotation shaft of the travel motor 11 so as to rotate along with rotation of the travel motor 11, which are disposed on each of the left and right ends of a bottom portion of the main body B.
The cleaning machine 100 includes a cleaning unit 3. The cleaning unit 3 is a device provided to the bottom portion of the main body B, so as to clean a floor surface F according to designated cleaning conditions. The cleaning unit 3 includes a cleaning liquid discharge port 31, a squeegee 33, and a cleaning member 35.
The cleaning liquid discharge port 31 is a hollow member having one end that discharges cleaning liquid, for example. For instance, the one end of the hollow member of the cleaning liquid discharge port 31 is disposed at a position corresponding to a cavity O1 formed in a fixing member 351 that fixes the cleaning member 35. On the other hand, the other end of the member is connected to an outlet side of a cleaning liquid supply pump 311 that supplies the cleaning liquid.
An inlet side of the cleaning liquid supply pump 311 is mounted inside the main body B, and is connected to an outlet of a cleaning liquid supply tank 313 that stores the cleaning liquid. With this structure, the cleaning liquid stored in the cleaning liquid supply tank 313 is adjusted in its supply amount by the cleaning liquid supply pump 311 and is supplied to the cleaning liquid discharge port 31. Then, it is discharged from the one end of the cleaning liquid discharge port 31 through the cavity O1 onto the floor surface F. The cleaning liquid can be water, for example.
The squeegee 33 is a member that is fixed to a squeegee fixing member 331 and is disposed on the rear side of the bottom surface of the main body B, so as to collect the cleaning liquid remaining on the floor surface F (the cleaning liquid after being used for cleaning the floor surface F). The squeegee 33 extends a predetermined length in the width direction of the main body B, and moves along with movement of the main body B, so as to form an area defined by the movement locus of the main body B and length of the squeegee 33 in the width direction (the area referred to as a squeegee locus). The squeegee 33 collects the cleaning liquid within the squeegee locus.
As the cleaning machine 100 includes the cleaning unit 3 described above, it can perform the cleaning operation so as to polish the floor surface F with the cleaning member 35 using the cleaning liquid.
The squeegee fixing member 331 is provided with a suction port O2. The suction port O2 is connected to a collecting member 335 (e.g., a container having a cavity) that is sucked by a suction motor 333 to become negative pressure inside. In this way, the suction port O2 generates a suction force P when suction by the suction motor 333 makes the collecting member 335 become negative pressure. As a result, the suction port O2 uses the suction force P to suck the cleaning liquid, dust, and the like collected by the squeegee 33, and can convey them to the collecting member 335. The suction force P generated at the suction port O2 can be adjusted by adjusting output of the suction motor 333, for example.
The squeegee fixing member 331 is connected to a squeegee lift actuator 337 via a joint J and can move up and down with respect to the floor surface F. In this way, the squeegee 33 can be arbitrarily set to contact with or separate from the floor surface F. As a result, the squeegee 33 can suppress the liquid (such as cleaning liquid) and the like on the floor surface F from moving to the rear of the cleaning machine 100.
The cleaning member 35 is a brush for cleaning the floor surface F, which is fixed to the fixing member 351 disposed on the front side of the bottom surface of the main body B. The fixing member 351 is connected to the output rotation shaft of a cleaning member rotating motor 353. Therefore, the cleaning member 35 rotates on the floor surface F with the cleaning liquid by rotation of the cleaning member rotating motor 353, so as to clean the floor surface F.
The cleaning machine 100 includes a control unit 5. The control unit 5 is a computer system including a CPU, a storage device (such as a RAM, a ROM, a hard disk drive, and an SSD), and various interfaces. The control unit 5 performs various controls regarding the cleaning machine 100 (as described later).
The cleaning machine 100 includes a travel path teaching unit 7. The travel path teaching unit 7 is a device that receives operator's operations to move the travel unit 1. The travel path teaching unit 7 is mounted via an attachment member 8 to the upper rear side of the main body B. In this way, the operator can operate the travel unit 1 to move by operating the travel path teaching unit 7 (as described later).
As another preferred embodiment, the travel path teaching unit 7 may not be mounted to the main body B. In this case, the travel path teaching unit 7 is a controller such as a joy stick, for example. In this way, the operator can remote control the cleaning machine 100.
The cleaning machine 100 includes a setting unit 9. The setting unit 9 is a console panel for various settings regarding the cleaning machine 100, and is mounted to the surface of the main body B on the upper rear side. In addition, the setting unit 9 is disposed near the travel path teaching unit 7. In this way, the operator can operate the setting unit 9 while operating the travel path teaching unit 7 so as to control the travel unit 1.
As another preferred embodiment, the travel path teaching unit 7 may not be mounted to the main body B. In this case, the travel path teaching unit 7 is a controller such as a joy stick, for example. In this way, the operator can remote control the cleaning machine 100.
With reference to
For instance, the operator who holds the handles 71a and 71b can apply a force to the cleaning machine 100 either in a pulling direction toward the operator or in a pushing direction, using the handles 71a and 71b. By adjusting forces applied to the handles 71a and 71b, respectively, the operator can adjust the travel direction of the cleaning machine 100. For instance, when a pulling force is applied to the right side handle 71a viewed from the front of cleaning machine 100, the cleaning machine 100 changes its direction to the left.
The handles 71a and 71b are mounted to the package 73 in a rotatable manner. In addition, the handles 71a and 71b are connected to the control unit 5 via a travel control command calculation unit 75. The travel control command calculation unit 75 converts rotations of the handles 71a and 71b into electric signals and outputs the signals to the control unit 5. In this way, the operator can control the cleaning machine 100 (the travel unit 1) by rotation operations of the handles 71a and 71b.
For instance, by adjusting rotation directions of the handles 71a and 71b, the operator may be able to switch the travel direction of the cleaning machine 100 between forward and backward. In addition, by adjusting rotation amounts of the handles 71a and 71b, a travel speed of the cleaning machine 100 may be adjustable. Furthermore, it may be possible to change the travel direction of the cleaning machine 100 by differentiating the rotation amounts between the handle 71a and the handle 71b.
With reference to
The setting unit 9 includes a manual operation memory switch 92. The manual operation memory switch 92 is a switch that starts or stops storing the operator's manual operations of the cleaning machine 100. Specifically, when the manual operation memory switch 92 is pressed after the operation mode is set to the manual operation mode by the selection unit 91, a manual operation teaching mode is started as a sub operation mode of the manual operation mode, in which cleaning conditions and a travel path of the manual operation performed by the operator are taught to the cleaning machine 100. On the other hand, when the manual operation memory switch 92 is switched while executing the manual operation teaching mode, the manual operation teaching mode is stopped.
The manual operation memory switch 92 can be a push button switch as illustrated in
As illustrated in
The cleaning condition adjusting section 931 includes a suction force adjusting section 931b for setting the suction force P at the suction port O2 as a teaching cleaning condition. The suction force adjusting section 931b is a push button switch, for example, and can adjust the suction force P by the number of pressing times of the button. In this way, the suckable range of the cleaning liquid on the floor surface F can be adjusted.
The cleaning condition adjusting section 931 includes a cleaning power adjusting section 931c for setting cleaning power W of the floor surface F by the cleaning member 35 as a teaching cleaning condition. The cleaning power adjusting section 931c is a push button switch, for example, and can adjust the cleaning power W of the floor surface F by the cleaning member 35 by the number of pressing times of the button.
The cleaning condition teaching unit 93 includes an operation selection section 933. The operation selection section 933 includes a supply selection section 933a for commanding supply start or stop of the cleaning liquid from the cleaning liquid discharge port 31. The supply selection section 933a can be a push button switch, for example, and can select supply start or supply stop of the cleaning liquid by pressing the button.
The operation selection section 933 includes a suction selection section 933b for commanding a suction start or stop by the suction port O2. The suction selection section 933b is a push button switch, for example, and can select suction start or suction stop by pressing the button.
The operation selection section 933 includes a cleaning selection section 933c for commanding a cleaning start or stop of the floor surface F by the cleaning member 35. The cleaning selection section 933c is a push button switch, for example, and can select cleaning start or stop of the floor surface F by pressing the button.
The setting unit 9 includes a pause switch 201 as illustrated in
The pause switch 201 is connected to a pause control unit 203 in the control unit 5 as illustrated in
The setting unit 9 includes a setting operation unit 95. The setting operation unit 95 includes a push switch or the like, for example, and receives input of various settings regarding to the cleaning machine 100, so as to output the same to the control unit 5 via a setting conversion unit 96.
The setting conversion unit 96 is a signal conversion circuit or a computer system that converts the input received by the setting operation unit 95 into a signal readable by the control unit 5.
The setting unit 9 includes a display 97. The display 97 displays various setting information regarding to the cleaning machine 100, which are currently set. The display 97 is a liquid crystal display, an organic EL display, or the like, for example.
In another preferred embodiment, the display 97 may further display a current operation mode (the autonomous travel mode, the manual operation mode, or the manual operation teaching mode), operating time, or a remaining level of battery for driving the cleaning machine 100.
In still another preferred embodiment, the display 97 may display various setting procedures when performing various settings of the cleaning machine 100 with the setting operation unit 95. In this way, it is possible to provide the operator with information regarding to the cleaning machine 100 in a visual manner, so that the operator can operate the setting unit 9 based on the displayed information.
In another preferred embodiment, the display 97 may be equipped with a touch panel. In this case, the selection unit 91, the manual operation memory switch 92, the setting operation unit 95 and/or the pause switch 201, which are described above, may be realized by the touch panel.
The setting unit 9 includes the cleaning condition teaching unit 93. The cleaning condition teaching unit 93 receives input of the cleaning conditions from the operator, and output the same to a cleaning control command calculation unit 94. The cleaning control command calculation unit 94 is a signal conversion circuit or a computer system that converts the cleaning conditions received by the cleaning condition teaching unit 93 into a signal readable by the control unit 5, and outputs the signal to the control unit 5.
With reference to
The control unit 5 may be a single computer system or a plurality of computer systems. If the control unit 5 is a plurality of computer systems, functions realized by the function blocks of the control unit 5 can be assigned to the computer systems at an arbitrary ratio for execution, for example.
With reference to
The cleaning selection unit 511 selects a connection between the terminal b and the terminal a or a connection between the terminal b and the terminal c, based on the operation mode selected by the selection unit 91, and thus determines which one of teaching cleaning conditions and reproduction cleaning conditions should be output to the cleaning unit control unit 513.
Specifically, if the manual operation mode (including the manual operation teaching mode) is selected by the selection unit 91, the cleaning selection unit 511 connects the terminal a and the terminal b, so as to connect the cleaning condition teaching unit 93 to the cleaning unit control unit 513 and the general control unit 55. In this way, when executing the manual operation mode or the manual operation teaching mode, the cleaning selection unit 511 can send the teaching cleaning conditions set by the cleaning condition teaching unit 93 to the cleaning unit control unit 513 and the general control unit 55. In addition, if the display 97 is connected to the terminal b, the teaching cleaning conditions can be displayed on the display 97.
On the other hand, if the autonomous cleaning mode is selected by the selection unit 91, the cleaning selection unit 511 connects the terminal b and the terminal c, so as to connect the general control unit 55 to the cleaning unit control unit 513. In this way, when executing the autonomous cleaning mode, the cleaning selection unit 511 can send the reproduction cleaning conditions output from the general control unit 55 to the cleaning unit control unit 513. In addition, if the display 97 is connected to the terminal b, the reproduction cleaning conditions can be displayed on the display 97.
Based on the received teaching cleaning conditions or reproduction cleaning conditions, the cleaning unit control unit 513 calculates control quantities to be output to a cleaning member rotating motor 353, a cleaning member pressing actuator 357, the cleaning liquid supply pump 311, and/or the suction motor 333, so as to output drive powers corresponding to the control quantities to the above-mentioned motor, pump, and/or actuator.
Specifically, based on the cleaning power W to the floor surface F as the cleaning condition, the cleaning unit control unit 513 calculates rotational frequency of the cleaning member rotating motor 353, and/or pressing force of the cleaning member pressing actuator 357, so as to output drive powers corresponding to the rotational frequency and the pressing force to the cleaning member rotating motor 353 and the cleaning member pressing actuator 357, respectively, thereby controls cleaning power of the cleaning member 35 to the floor surface F.
Based on the supply amount S of the cleaning liquid as the cleaning condition, the cleaning unit control unit 513 calculates cleaning liquid flow rate of the cleaning liquid supply pump 311, so as to output the drive power corresponding to the flow rate to the cleaning liquid supply pump 311, thereby controls cleaning liquid amount discharged from the cleaning liquid discharge port 31.
Based on the suction force P as the cleaning condition, the cleaning unit control unit 513 calculates rotational frequency (and/or output) of the suction motor 333, so as to output the drive power corresponding to the rotational frequency (and/or output) to the suction motor 333, thereby controls the suction force at the suction port O2. The cleaning unit control unit 513 outputs a drive signal to move the squeegee 33 up and down to the actuator, so that it can move the squeegee 33 up and down.
The cleaning member 35 is connected to the cleaning member pressing actuator 357 via a pressing member 355. In this way, the cleaning member 35 is pressed to the floor surface F and rotates so that it can clean the floor surface F. By adjusting the rotational frequency of the cleaning member rotating motor 353 and the pressing force of the cleaning member pressing actuator 357, the cleaning power of the cleaning member 35 to the floor surface F can be adjusted. As the cleaning member 35, a floor surface cleaning brush or the like can be used, for example.
As the cleaning unit 3 has the structure described above, the cleaning machine 100 can perform various cleaning operations, such as cleaning of the floor surface F and collecting liquid (cleaning liquid) on the floor surface F.
With reference to
Based on the operation mode selected by the selection unit 91, the travel selection unit 531 selects a connection between the terminal e and the terminal d or a connection between the terminal e and the terminal f. Specifically, if the manual operation mode is selected by the selection unit 91, the travel selection unit 531 connects the terminal e and the terminal d, so as to connect the travel path teaching unit 7 and the motor control unit 533. In this way, when executing the manual operation mode or the manual operation teaching mode, the travel selection unit 531 can send to the motor control unit 533 a signal indicating the rotation amounts and/or the rotation directions of the handles 71a and 71b of the travel path teaching unit 7.
On the other hand, if the autonomous cleaning mode is selected by the selection unit 91, the travel selection unit 531 connects the terminal e and the terminal f, so as to connect the general control unit 55 and the motor control unit 533. In this way, when executing the autonomous cleaning mode, the travel selection unit 531 can send to the motor control unit 533 a reproduction travel control command output from the general control unit 55.
Based on the input rotation amounts and rotation directions of the handles 71a and 71b, or the reproduction travel control command, the motor control unit 533 calculates a target rotation speed of the travel motor 11, and outputs to the travel motor 11 a drive power to rotate the travel motor 11 at the target rotation speed. The motor control unit 533 calculates and feeds back an actual rotation speed of the travel motor 11 based on the pulse signal from the encoder 111, and calculates a drive power to be output to the travel motor 11. Therefore, the motor control unit 533 controls the travel motor 11 using a proportional integral (PI) control theory, a proportional integral differential (PID) control theory, or the like, for example.
In this preferred embodiment, the travel motor 11 and the main wheel 13 are mounted to each of the left and right ends of the bottom portion of the main body B. In this case, the motor control unit 533 controls the rotation speeds and the rotation directions of the left and right travel motors 11 independently, so as to determine the travel direction of the cleaning machine 100.
In another preferred embodiment, if the control unit 5 includes a plurality of computer systems, the motor control unit 533 may be one of the computer systems. In other words, it may be possible that one computer system realizes only the function of the motor control unit 533. In this case, the motor control unit 533 is a motor control device using the PI control theory or the PID control theory, for example.
With reference to
The cleaning schedule creation unit 553 associates the teaching position information, the teaching cleaning conditions, and the teaching data obtaining time obtained from the teaching data obtaining unit 551 with each other, creates a cleaning schedule 500 (an example of the stored information), and stores the same in a storage unit 57.
The SLAM unit 555 estimates information about position on a predetermined coordinate (position information) of the cleaning machine 100, based on information about an obstacle in front of the cleaning machine 100 obtained by a front detector 5551a (
The front detector 5551a and the rear detector 5551b are laser range finders (LRF) having a detection range of 180 degrees or more. If the laser range finder is used as the front detector 5551a and the rear detector 5551b, it obtains a distance between travel unit 1 and an obstacle and a direction to the obstacle, as the information about the obstacle.
The general control unit 55 includes a cleaning reproduction unit 559. When executing the autonomous cleaning mode, the cleaning reproduction unit 559 calculates the reproduction cleaning conditions and the reproduction travel control command at a predetermined elapsed time from start of execution of the autonomous cleaning mode, based on the teaching data obtaining time, the teaching cleaning conditions, and the teaching position information stored in the cleaning schedule 500, so as to output them to the cleaning control unit 51 and the travel control unit 53, respectively.
With reference to
The local map is map information about (positions of) obstacles around the cleaning machine 100. The local map is created as necessary by coordinate conversion of the information about the front obstacle obtained by the front detector 5551a and the information about the rear obstacle obtained by the rear detector 5551b.
The global map is map information about (positions of) obstacles existing in an environment (movement environment) in which the cleaning machine 100 moves when cleaning the floor surface F. The global map is created based on the local map obtained when executing the manual operation teaching mode. Therefore, the local map is associated with time when it is obtained (e.g., the teaching data obtaining time) and is stored in the storage unit 57.
In another preferred embodiment, the local map may be stored in the storage unit 57 in association with the estimated position of the cleaning machine 100 when it is obtained.
In still another preferred embodiment, the global map may be created by using dedicated software or a CAD. In this case, the global map created by the software or the like is converted into data readable by the control unit 5 of the cleaning machine 100.
The map creation section 5553 locates a local map associated with a certain elapsed time and a local map associated with a time near the certain elapsed time, at positions of the cleaning machine 100 at the elapsed times (locates the centers of the local maps at positions of the cleaning machine 100 at the corresponding elapsed times), so as to crate map information indicating a portion of the movement environment (e.g., a range necessary for position estimation), as the global map. In addition, the map creation section 5553 deletes a portion of the global map created in the past, which becomes unnecessary for position estimation.
In another preferred embodiment, if a “circular path problem” (a problem that a portion of the global map created in the initial stage is not identical to a portion of the global map created in the final stage), such as a case where the movement environment does not define a circular path, does not occur, map information indicating the entire movement environment may be created as the global map.
The SLAM unit 555 includes the position estimation section 5555. The position estimation section 5555 estimates position information about position of the cleaning machine 100 on a predetermined coordinate, based on the global map created by the map creation section 5553, the local map, and the rotation amount of the travel motor 11 output from the encoder 111.
Specifically, the position information is estimated as follows. Here, as an example, suppose a case in which the cleaning machine 100 moves from a (estimated) position at predetermined time point (referred to as time point tk) to reach a position at a next time point (referred to as time point tk+1), and the latter position is to be estimated.
First, the position estimation section 5555 calculates a rotation amount of the main wheel 13 between time point tk and time point tk+1 from the number of pulses output from the encoder 111 between time point tk and time point tk+1, and estimates a movement length of the cleaning machine 100 due to rotation of the main wheel 13 based on the rotation amount (dead reckoning).
Next, the position estimation section 5555 moves posterior probability at time point tk (corresponding to probability distribution indicating a relationship between the position of the cleaning machine 100 and a probability that the cleaning machine 100 exists at the position at time point tk) by the movement length of the cleaning machine 100 due to rotation of the main wheel 13, so as to calculate prior probability at time point tk+1.
After that, the position estimation section 5555 obtains the local map and the global map at time point tk+1 from the map creation section 5553, and estimates position information of the cleaning machine 100 at time point tk+1 by map matching between the local map and the global map at time point tk+1.
Specifically, for example, on the global map, the local map at time point tk+1 is located at some positions near the estimated position calculated based on rotation amount of the main wheel 13, and the local map is rotated about the center thereof if necessary (e.g., if the direction of the cleaning machine 100 is changed), and the map matching is performed.
Based on a result of the map matching, the position estimation section 5555 calculates a likelihood (corresponding to a relationship between a position at which the local map information is located and a matching degree between the global map and the local map information at the position).
After that, the position estimation section 5555 multiplies the likelihood by the prior probability at time point tk+1, so as to calculate the posterior probability at time point tk+1. The position estimation section 5555 estimates the position when the posterior probability at time point tk+1 becomes maximum, namely the position at which the cleaning machine 100 is estimated to exist with the highest probability, to be the position (position information) of the cleaning machine 100 at time point tk+1. The posterior probability at time point tk+1 is used as the prior probability in the next position estimation.
As described above, the position estimation section 5555 uses the movement length based on a rotation amount of the main wheel 13 and map information obtained using the front detector 5551a and the rear detector 5551b, so as to perform position estimation. Thus, it is possible to perform accurate position estimation, by complementarily reducing an error included in the movement length based on a rotation amount of the main wheel 13 (mainly due to slip between the main wheel 13 and the floor surface F), and an error included in the map information (mainly due to noise components included in the information obtained by the front detector 5551a and the rear detector 5551b).
The SLAM unit 555 includes an elapsed time determination section 5557. The elapsed time determination section 5557 determines the teaching data obtaining time and elapsed time from start of execution of the autonomous cleaning mode. In this preferred embodiment, the elapsed time determination section 5557 determines teaching data obtaining time using a clock function of a microcomputer system of the control unit 5, for example.
On the other hand, the elapsed time from start of execution of the autonomous cleaning mode is determined based on the position information estimated by the position estimation section 5555. Specifically, for example, the elapsed time is determined as the teaching data obtaining time associated with position information that is closest to position information of the cleaning machine 100 estimated by the position estimation section 5555, among position information stored in the cleaning schedule 500.
As the elapsed time from start of execution of the autonomous cleaning mode is determined based on position information estimated by the position estimation section 5555, the cleaning machine 100 can autonomously reproduce the cleaning operation while accurately recognizing timing and place to execute the taught teaching cleaning conditions, when executing the autonomous cleaning mode.
As illustrated in
When the stopping operation of the pause switch 201 is performed during the teaching travel, the pause control unit 203 controls the motor control unit 533 to stop traveling of the main body B. In addition, the pause control unit 203 controls the cleaning schedule creation unit 553 to stop storing the teaching position information and the teaching data obtaining time in the storage unit 57 (i.e., to stop creating the cleaning schedule 500). Note that the timing to stop traveling of the main body B and stop creating the cleaning schedule 500 can be determined and changed by the pause control unit 203 according to input from the setting operation unit 95. Note that the cleaning machine 100 is moved by a user's moving operation during non-pause, but it is not moved during a pause even by the moving operation.
If a resuming operation of the pause switch 201 is performed during the pause described above, the cleaning machine 100 can be moved. Further, when the user operates the travel path teaching unit 7 to control the motor control unit 533, traveling of the main body B is resumed. In addition, the pause control unit 203 causes the cleaning schedule creation unit 553 to resume storing the teaching position information and the teaching data obtaining time in the storage unit 57 (i.e., to resume creating the cleaning schedule 500). Note that the timing to resume traveling of the main body B and creating the cleaning schedule 500 can be determined and changed by the pause control unit 203 according to input from the setting operation unit 95.
In the cleaning schedule 500, vertical movement of the squeegee 33, suction operation from the squeegee 33, discharge of water, and the like are recorded as operations of the cleaning machine 100. Therefore, if the stopping operation of the pause switch 201 is performed, the pause control unit 203 also controls the cleaning schedule creation unit 553 to stop recording the above operation. In addition, if the resuming operation of the pause switch 201 is performed, recording of the above operation is resumed.
With reference to
In Step S2, the cleaning machine 100 autonomously performs the cleaning operation according to the cleaning schedule 500 stored in the storage unit 57.
In Step S3, it is determined whether or not the manual operation memory switch 92 is pressed during execution of the manual operation mode. If the manual operation memory switch 92 is pressed, the process proceeds to Step S4. If the manual operation memory switch 92 is not pressed, the process proceeds to Step S5.
In Step S4, the control unit 5 changes the operation mode to the manual operation teaching mode. As a result, operator's cleaning operation after the timing when the manual operation memory switch 92 is pressed is stored as the cleaning schedule 500.
In Step S5, the execution of the manual operation mode is maintained, in which the cleaning operation of the cleaning machine 100 due to the operator's operation is not stored.
In Step S4 described above, while executing the manual operation teaching mode, the control unit 5 monitors whether or not the manual operation memory switch 92 is pressed. If the manual operation memory switch 92 is pressed during execution of the manual operation teaching mode, the manual operation teaching mode is finished at the timing, and the operation mode is changed to the manual operation mode, in which the cleaning operation after the timing is not stored in the cleaning schedule 500. In other words, by pressing the manual operation memory switch 92 during execution of the manual operation teaching mode, the operator can stop the storing (teaching) at any timing during the cleaning operation.
As described above, the cleaning machine 100 according to this preferred embodiment can execute the autonomous cleaning mode, the manual operation mode, or the manual operation teaching mode, in accordance with selection of the operation mode by the selection unit 91 and whether or not the manual operation memory switch 92 is pressed.
With reference to
Specifically, at a timing (elapsed time: 0) when the manual operation memory switch 92 is pressed, the teaching data obtaining unit 551 receives the supply amount S of the cleaning liquid, the suction force P, and the cleaning power W, which are respectively output to the cleaning liquid supply pump, the suction motor 333, and the cleaning member rotating motor 353 and the cleaning member pressing actuator 357, from the cleaning control unit 51 at the timing, as the teaching cleaning conditions at elapsed time 0. In addition, it instructs the position estimation section 5555 to estimate position information of the cleaning machine 100 at elapsed time 0, and receives the estimated position information as the teaching position information.
The cleaning schedule creation unit 553 receives the teaching position information and the teaching cleaning conditions at elapsed time 0 from the teaching data obtaining unit 551, and associates the teaching position information and the teaching cleaning conditions with elapsed time 0 so as to store them in the storage unit 57, as the cleaning schedule 500.
In Step S12, the teaching data obtaining unit 551 monitors elapsed time determined by the elapsed time determination section 5557, and determines whether or not the elapsed time is the teaching data obtaining time. If it is the teaching data obtaining time, the process proceeds to Step S13.
In Step S13, it receives from the position estimation section 5555 position information at the teaching data obtaining time as the teaching position information, and receives from the cleaning control unit 51 cleaning conditions at the teaching data obtaining time as the teaching cleaning conditions. In this way, it can obtain the teaching position information and the teaching cleaning conditions every period of the teaching data obtaining time. The teaching data obtaining time can be a timing of every predetermined time (e.g., about 500 ms) from pressing the manual operation memory switch 92, for example.
In Step S14, the cleaning schedule creation unit 553 associates the teaching position information and the teaching cleaning conditions obtained by the teaching data obtaining unit 551 with the teaching data obtaining time when obtaining them, and stores them in the cleaning schedule 500.
Steps S11 to S14 described above are repeatedly executed until the operator's cleaning operation is finished (until “Yes” in Step S15), and thus the teaching position information and the teaching cleaning conditions from start to end of the operator's cleaning operation can be stored as the cleaning schedule 500.
The end of the cleaning operation (storing thereof) can be commanded by pressing the manual operation memory switch 92 during execution of the manual operation teaching mode. In another preferred embodiment, it may be possible that the end of the cleaning operation (storing thereof) can be commanded also when emergency stop is commanded with an emergency stop button or the like.
With reference to
In Step S21, the SLAM unit 555 first obtains information about a front obstacle and information about a rear obstacle from the front detector 5551a and the rear detector 5551b.
In Step S22, the position estimation section 5555 estimates position of the cleaning machine 100 on the x-y coordinate, based on a rotation amount of the travel motor 11 measured by the encoder 111, the global map, and the local map obtained based on the information obtained in Step S21 (Step S22). For instance, it is supposed that position of the cleaning machine 100 is estimated to be (xn′, yn′, θn′) on the x-y coordinate.
In Step S23, after position of the cleaning machine 100 is estimated, the elapsed time determination section 5557 determines an elapsed time tn from a start of execution of the autonomous cleaning mode.
In Step S24, the cleaning reproduction unit 559 calculates the reproduction travel control command and the reproduction cleaning conditions at an elapsed time tn as follows.
It is supposed that the elapsed time tn is (closest to) the teaching data obtaining time TL. In this case, the cleaning reproduction unit 559 reads out position information (xL+1, yL+1, θL+1) associated with next teaching data obtaining time TL+1 from the cleaning schedule 500, and calculates the reproduction travel control command at elapsed time tn, based on difference (xL+1−xn′, yL+1−yn′, θL+1−θn′) between the estimated position information and the target position information.
On the other hand, the cleaning reproduction unit 559 reads out cleaning conditions (SL, WL, PL) associated with the teaching data obtaining time TL from the cleaning schedule 500, and determines the cleaning conditions (SL, WL, PL) to be the reproduction cleaning conditions at the elapsed time tn.
In Step S25, the cleaning reproduction unit 559 outputs the reproduction travel control command to the travel control unit 53, and outputs the reproduction cleaning conditions to the cleaning control unit 51. When executing the autonomous cleaning mode, the terminal e and the terminal f of the travel selection unit 531 are connected to each other, and hence the reproduction travel control command is sent to the motor control unit 533 via the travel selection unit 531. The motor control unit 533 controls the travel motor 11 based on the received reproduction travel control command.
On the other hand, in the cleaning selection unit 511, the terminal b and the terminal c are connected to each other, and hence the reproduction cleaning conditions are sent to the cleaning unit control unit 513 via the cleaning selection unit 511. The cleaning unit control unit 513 controls the cleaning unit 3 based on the received reproduction cleaning conditions.
In Step S26, after controlling the travel unit 1 and the cleaning unit 3 based on the reproduction travel control command and the reproduction cleaning conditions, respectively, the cleaning reproduction unit 559 checks whether or not all the cleaning operations stored in the cleaning schedule 500 are performed. Whether or not all the cleaning operations stored in the cleaning schedule 500 are finished can be checked by detecting an identifier at the end of the cleaning schedule 500 (such as an identifier indicating “end of file”), for example.
As long as it is determined that all the cleaning operations stored in the cleaning schedule 500 are not performed, Steps S21 to S25 described above are repeatedly executed. When it is determined that all the cleaning operations stored in the cleaning schedule 500 are performed (“Yes” in Step S26), the execution of the reproduction cleaning mode is finished. In this way, the cleaning machine 100 can faithfully reproduce the cleaning operation stored in the cleaning schedule 500.
By executing Steps S21 to S26 described above, the cleaning reproduction unit 559 calculates the reproduction cleaning conditions and the reproduction travel control command based on the cleaning schedule 500 created by the cleaning schedule creation unit 553, and outputs them to the cleaning unit 3 and the travel unit 1, respectively, thereby causes the cleaning machine 100 to autonomously perform the cleaning operation.
With reference to
As illustrated in
In Step S42, the travel stopping operation of the cleaning machine 100 is performed. Specifically, the cleaning machine 100 reduces its speed and stops (its travel speed becomes substantially zero). The operation described above is performed when the pause control unit 203 controls the motor control unit 533.
In Step S43, the recording is stopped. Specifically, the above operation is performed when the pause control unit 203 controls the cleaning schedule creation unit 553 to stop recording of the cleaning schedule 500. In this preferred embodiment, the recording is stopped at a predetermined time after stopping traveling of the cleaning machine 100 (complete stop after reducing speed in Step S42).
In Step S44, it is determined whether or not the resuming operation of the pause switch 201 has been performed. Specifically, the pause control unit 203 performs the above determination.
In Step S45, the recording is resumed. Specifically, the above operation is performed when the pause control unit 203 controls the cleaning schedule creation unit 553 to resume recording of the cleaning schedule 500. In this preferred embodiment, the recording is resumed simultaneously with the operator's resuming operation of the pause switch 201.
In Step S46, the traveling of the cleaning machine 100 is started. Specifically, after a predetermined time elapses from the resuming operation of the pause switch 201, the cleaning machine 100 starts increasing speed. The above operation is realized when the pause control unit 203 controls the motor control unit 533.
In Step S47, the record before stopping recording and the record after resuming recording are joined and stored in the storage unit 57. In other words, the cleaning schedule creation unit 553 joins the records so as to create the cleaning schedule 500. As a result, information of speed and position in the teaching travel illustrated in
In this method, when the operator performs the stopping operation of the pause switch 201 in the teaching travel, the travel stopping operation of the cleaning machine 100 and stopping recording are performed. In addition, when the operator performs the resuming operation of the pause switch 201 in the teaching travel, traveling of the cleaning machine 100 is started and the recording is started. In the recording, the record before stopping recording and the record after resuming recording are joined.
Therefore, in the copy travel, using the record in which record before stopping recording and record after stopping recording are joined, the cleaning machine 100 can travel. In other words, in the copy travel, the problem that position and speed of the cleaning machine 100 become discontinuous does not occur. As a result, in the reproduction travel, the cleaning machine 100 can smoothly travel when traveling based on the record before stopping recording and the record after resuming recording in the teaching travel.
As the conventional problem is solved as described above, there is another effect that evacuation of obstacles on the path or other work can be performed after stopping the cleaning machine 100 during the teaching travel. In addition, the operator can wait other person or object to pass or can leave for checking a route or resting during the teaching travel.
As still another effect, in this preferred embodiment, in the above case, the operator can perform the travel stopping operation and stopping recording with the pause switch 201, so that the above obstacle information is not left in the map. Conventionally, in the teaching travel, a person's locus may be left on the map when the person passes by in a public space or the like, and an operation to avoid the left person's locus as an obstacle will occur. In addition, as unnecessary information is left in the map, navigation performance is deteriorated. However, in this preferred embodiment, such problems are solved. This effect can be obtained not only in the case of copy travel but also in an outer periphery direct teaching (filling travel).
In the first preferred embodiment, stopping recording (Step S43) is performed a predetermined time after stopping traveling (complete stop after reducing speed in Step S42), and resuming recording (Step S45) is performed simultaneously with the resuming operation of the pause switch 201 (Yes in Step S44). Therefore, the stop state (time range A, B in
In the copy travel, as illustrated in
Furthermore, due to the above operation, the cleaning machine 100 can realize desirable operations. Specifically, in the copy travel, at a place to pause, it can reproduce a preparation operation such as moving up and down the cleaning member 35 that is a brush in the time range B, for example. In other words, in the teaching travel, when teaching an operation to move down the cleaning member 35 and then to start traveling in the time range B after the resuming operation of the pause switch 201, operation time to move down the cleaning member 35 is secured. Therefore, in the copy travel, it is possible to move the cleaning machine 100 after the cleaning member 35 is completely moved down. As a result, cleaning quality is not deteriorated.
With reference to
Note that in the following description of the control operation,
The travel teaching recording method of the second preferred embodiment includes the following steps. In Step S41, it is determined whether or not the operator has performed the stopping operation of the pause switch 201. Specifically, the pause control unit 203 performs the above determination. If the stopping operation is performed, the process proceeds to Step S42.
In Step S42, travel stopping operation of the cleaning machine 100 is performed. Specifically, the cleaning machine 100 reduces speed and stops (travel speed becomes substantially zero).
In Step S43, recording is stopped. In this preferred embodiment, recording is stopped simultaneously with stopping traveling of the cleaning machine 100 (complete stop after reducing speed in Step S42).
In Step S44, it is determined whether or not the resuming operation of the pause switch 201 has been performed. Specifically, the pause control unit 203 performs the above determination.
In Step S45, recording is resumed. In this preferred embodiment, recording is resumed simultaneously with starting traveling of the cleaning machine 100 (in Step S46 described later).
In Step S46, traveling of the cleaning machine 100 is started. Specifically, after a predetermined time elapses from the resuming operation of the pause switch 201, the user operates the travel path teaching unit 7 to control the motor control unit 533, thereby traveling of the main body B is resumed.
In Step S47, the record before stopping recording and the record after resuming recording are joined and stored in the storage unit 57.
In this preferred embodiment, stopping recording (Step S43) is performed simultaneously with stopping traveling (complete stop after reducing speed in Step S42), and resuming recording (Step S45) is performed simultaneously with starting traveling (Step S46). Therefore, the stop state of the cleaning machine 100 (the state after stopping traveling until starting traveling, time range C in
With reference to
The travel teaching recording method of the third preferred embodiment includes the following steps. In Step S41, it is determined whether or not the operator has performed the stopping operation of the pause switch 201. Specifically, the pause control unit 203 performs the above determination. If the stopping operation is performed, the process proceeds to Step S42.
In Step S42, the travel stopping operation of the cleaning machine 100 is performed. Specifically, the cleaning machine 100 reduces speed and stops.
In Step S43, recording is stopped. In this preferred embodiment, recording is stopped simultaneously with the operator's stopping operation of the pause switch 201.
In Step S44, it is determined whether or not the resuming operation of the pause switch 201 has been performed. Specifically, the pause control unit 203 performs the above determination.
In Step S45, the recording is resumed. In this preferred embodiment, a timing to resume recording is a predetermined time after starting traveling of the cleaning machine 100 (e.g., after acceleration is finished, i.e., after a constant speed is reached).
In Step S46, the traveling of the cleaning machine 100 is started. Specifically, after a predetermined time elapses from the resuming operation of the pause switch 201, the user operates the travel path teaching unit 7 to control the motor control unit 533, thereby traveling of the main body B is resumed.
In Step S47, the record before stopping recording and the record after resuming recording are joined and stored in the storage unit 57 as the cleaning schedule 500.
In this preferred embodiment, recording is stopped simultaneously with the operator's stopping operation of the pause switch 201, and recording is resumed after the cleaning machine 100 finishes acceleration, i.e., after a constant speed is reached. Therefore, in the teaching travel, recording is not performed while the cleaning machine 100 decelerates, stops, and accelerates (time range E in
In Step S47, specifically, there is executed a step of creating information for joining information of the recording stop position and information of the recording resume position. Specifically, during the teaching travel, linear interpolation between information of the recording stop position (position and speed) and information of the recording resume position (position and speed) is performed, so as to create a plurality of interpolation points. Then, in the autonomous travel, the record is edited by interpolation or the like so as to smoothly join position and speed between the recording stop position and the recording resume position.
Note that in the above editing, it may be possible to edit either or both before and after the period after the recording stop position until the recording resume position. Note that the interpolation of records is not limited to the linear interpolation, but a method of using a spline curve may be adopted, for example.
With reference to
The travel teaching recording method of the fourth preferred embodiment includes the following steps. In Step S41, it is determined whether or not the operator has performed the stopping operation of the pause switch 201. Specifically, the pause control unit 203 performs the above determination. If the stopping operation is performed, the process proceeds to Step S42.
In Step S42, traveling of the cleaning machine 100 is stopped. Specifically, the cleaning machine 100 reduces speed and stops (travel speed becomes zero).
In Step S43, recording is stopped. In this preferred embodiment, recording is stopped simultaneously with stopping traveling of the cleaning machine 100.
In Step S44, it is determined whether or not the resuming operation of the pause switch 201 has been performed. Specifically, the pause control unit 203 performs the above determination.
In Step S45, recording is resumed. In this preferred embodiment, recording is resumed simultaneously with starting traveling of the cleaning machine 100 (in Step S46 described later).
In Step S46, traveling of the cleaning machine 100 is started. Specifically, after a predetermined time elapses from the resuming operation of the pause switch 201, the user operates the travel path teaching unit 7 to control the motor control unit 533, thereby traveling of the main body B is resumed.
In Step S47, the record before stopping recording and the record after resuming recording are joined and stored in the storage unit 57.
In this preferred embodiment, the cleaning schedule 500 after the operator's stopping operation of the pause switch 201 until stopping recording is edited (i.e., information of the cleaning schedule 500 is interpolated, for example, so as to smoothly join position, speed, and cleaning operation between the recording stop position and the recording resume position). Specifically, the cleaning schedule creation unit 553 edits the cleaning schedule 500 as described above. For instance, as illustrated in
In this preferred embodiment, as described above, stopping recording (Step S43) is performed simultaneously with stopping traveling (complete stop after reducing speed in Step S42), and resuming recording (Step S45) is performed simultaneously with resuming travel (start acceleration in Step S46). Therefore, the stop state of the cleaning machine 100 (state after stopping traveling until starting travel) is not recorded. As a result, in the copy travel, as illustrated in
In this preferred embodiment, as described above, the stored information is edited so as to reduce deceleration after the operator's stopping operation of the pause switch 201 until stopping recording (the deceleration time range G in
Therefore, in the copy travel, as illustrated in
As described above, in the edition described above, both before and after the period after the stopping operation of the pause switch 201 until stopping recording are edited. However, it may be possible to edit only the period after the stopping operation of the pause switch 201 until stopping recording, or plus either one of before and after the period.
With reference to
As illustrated in
The record pause control unit 209 performs various control based on an operation of the record pause switch 207. Specifically, the pause control unit 203 can control the cleaning schedule creation unit 553 in the general control unit 55 (see
The record pause switch 207 is enabled only during a stop of the main body B. For instance, if a record pause switch 207b is an icon button on the touch panel, the record pause switch 207 is grayed-out and disabled while the cleaning machine 100 is traveling. When the cleaning machine 100 stops traveling, the grayed-out display is released so as to enable the record pause switch 207.
If the stopping operation of the record pause switch 207 is performed during stop of the main body B, the record pause control unit 209 controls the cleaning schedule creation unit 553 to stop recording the cleaning schedule 500 (i.e., recording position and time of the main body B is stopped).
If the resuming operation of the record pause switch 207 is performed during recording pause described above, the record pause control unit 209 controls the cleaning schedule creation unit 553 to resume recording the cleaning schedule 500 (i.e., recording position and time of the main body B is resumed).
With reference to
The travel teaching recording method according to the fifth preferred embodiment includes the following steps. In Step S51, it is determined whether or not the operator has performed the stopping operation of the record pause switch 207. Specifically, the record pause control unit 209 performs the above operation. If the stopping operation is performed, the process proceeds to Step S52.
In Step S52, it is determined whether or not the main body B is stopped. If it is stopped, the process proceeds to Step S53. If it is not stopped, the process returns to Step S51.
In Step S53, recording is promptly stopped.
In Step S54, it is determined whether or not the resuming operation of the record pause switch 207 has been performed. Specifically, the record pause control unit 209 performs the above operation. If the resuming operation is performed, the process proceeds to Step S55.
In Step S55, recording is promptly resumed.
In Step S56, the record before stopping recording and the record after resuming recording are joined and stored.
In this method, during the teaching travel, the record pause switch 207 is disabled. When the cleaning machine 100 stops, the record pause switch 207 is enabled. During stopping of the cleaning machine 100, the operator performs the stopping operation of the record pause switch 207, and then performs the resuming operation of the record pause switch 207. When the stopping operation of the record pause switch 207 is performed, recording is promptly stopped. When the resuming operation of the record pause switch 207 is performed, recording is promptly resumed. As described above, in
Therefore, in the copy travel, as illustrated in
As another preferred embodiment, there is described an example of filling travel, in which the control unit determines an autonomous travel path within an outer periphery taught by the operator by outer periphery direct teaching in advance, and the determined autonomous travel path is autonomously traveled. The cleaning machine 100 that is the same as that of the first preferred embodiment performs outer periphery direct teaching. In this case, position and map are recorded (time point is not recorded).
In the teaching travel, the travel teaching recording method of the first to fifth preferred embodiments described above is performed, and it is prevented that unnecessary information remains on the map. As a result, deterioration in navigation performance can be prevented. In this preferred embodiment, for example, when a large obstacle such as a cart passes by, the operator can operate the pause switch 201 to stop traveling of the cleaning machine 100, so as to prevent information of the obstacle from remaining on the map.
Although preferred embodiments of the present invention are described above, the present invention is not limited to the preferred embodiments described above, but can be variously modified within the scope of the present invention without deviating from the spirit thereof. In particular, the preferred embodiments and variations described in this specification can be arbitrarily combined as necessary.
As a variation of the first to fourth preferred embodiments, the timing to stop traveling of the main body B and creating the cleaning schedule 500 and the timing to resume traveling of the main body B and creating the cleaning schedule 500 can be any appropriate combination of their patterns of the first to fourth preferred embodiments.
In the cleaning machine, the structure of the cleaning unit and the cleaning method are not particularly limited.
The pause switch in the first to fourth preferred embodiments may be realized by two switches (e.g., a stopping operation switch and a resuming operation switch).
The record pause switch in the fifth preferred embodiment may be realized by two switches (e.g., a stopping operation switch and a resuming operation switch).
Stopping recording and resuming recording are performed in the third preferred embodiment, but as a variation, it may be possible to join the position when the stopping operation is performed and the position when the constant speed travel is started, by editing without stopping recording and resuming recording.
The autonomous traveling body may be a device or machine other than a cleaning machine. For instance, the autonomous traveling body may be a golf ball collecting machine, or a lawn mower. Device operations of the golf ball collecting machine (instructed states or instructable real states to be controlled that are unique to the device and are to be reproduced in the autonomous travel) include a ball collecting operation, and a ball discharging operation. Device operations of the lawn mower include driving and stopping a cutter.
Preferred embodiments of the present invention can be widely applied to travel teaching recording methods for an autonomous traveling body.
While preferred embodiments of the present invention have been described above, it is to be understood that variations and modifications will be apparent to those skilled in the art without departing from the scope and spirit of the present invention. The scope of the present invention, therefore, is to be determined solely by the following claims.
Number | Date | Country | Kind |
---|---|---|---|
2020-184359 | Nov 2020 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2021/029857 | 8/16/2021 | WO |