Automatically travelling device and control method therefor
10105838 ยท 2018-10-23
Assignee
Inventors
- Guoliang Mou (Suzhou, CN)
- Jiaofeng Tian (Suzhou, CN)
- Xiaochu Sheng (Suzhou, CN)
- Hongbing WU (Suzhou, CN)
- Dongjing Song (Suzhou, CN)
Cpc classification
G05D1/0225
PHYSICS
B25J19/005
PERFORMING OPERATIONS; TRANSPORTING
B25J9/1664
PERFORMING OPERATIONS; TRANSPORTING
Y10S901/49
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
B25J9/1674
PERFORMING OPERATIONS; TRANSPORTING
B60L3/0046
PERFORMING OPERATIONS; TRANSPORTING
Y02T90/14
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
Y02T10/70
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
B60L2220/46
PERFORMING OPERATIONS; TRANSPORTING
Y10S901/01
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
B25J9/0003
PERFORMING OPERATIONS; TRANSPORTING
B60L58/14
PERFORMING OPERATIONS; TRANSPORTING
Y02T90/16
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
Y02T10/72
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
B60L58/21
PERFORMING OPERATIONS; TRANSPORTING
B60L15/2036
PERFORMING OPERATIONS; TRANSPORTING
B60L58/16
PERFORMING OPERATIONS; TRANSPORTING
Y02P90/60
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
Y02T10/64
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
B60L58/13
PERFORMING OPERATIONS; TRANSPORTING
B60L50/40
PERFORMING OPERATIONS; TRANSPORTING
Y02T90/12
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
Y02T10/7072
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
International classification
B25J9/00
PERFORMING OPERATIONS; TRANSPORTING
B60L3/00
PERFORMING OPERATIONS; TRANSPORTING
H02J7/00
ELECTRICITY
B60L15/20
PERFORMING OPERATIONS; TRANSPORTING
B25J19/00
PERFORMING OPERATIONS; TRANSPORTING
B25J11/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
An automatic moving device and a control method therefor. The automatic moving device comprises a battery pack providing power. The automatic moving device can work within a working area and automatically return to a charging station for charging. The control method comprises monitoring the power level of the battery pack; if the power level of the battery pack is less than or equal to a preset power level, initiating an action of returning the automatic moving device to the charging station; and after a preset time period, stopping the travel. By setting a preset time period simultaneously with initiating a return action, and executing a return action within the preset time period, the control method prevents damage to the battery pack from over-discharging caused by the automatic moving device continually returning, thus achieving the effects of protecting the battery pack and extending the life thereof.
Claims
1. A method for controlling an automatic moving device, the automatic moving device comprising a power module configured to provide power and wherein the automatic moving device is adapted to operate in a work area and automatically return to a docking station, the method comprising: controlling the automatic moving device with a control module to start moving; detecting an energy level of the power module with a power-detecting unit; calculating a rate of change of the energy level of the power module with the control module; and controlling the automatic moving device with the control module to stop moving when an absolute value of the rate of change of the energy level reaches or exceeds a preset threshold value.
2. The method according to claim 1, further comprising setting the preset threshold value.
3. The method according to claim 2, wherein setting the preset threshold value comprises: setting the preset threshold value according to at least one of the following parameters: a type of battery pack; a load level; or a discharging temperature.
4. The method according to claim 1, wherein the rate of change of the energy level is first derivatives, second derivatives or higher derivatives of the energy level with respect to time.
5. The method according to claim 1, wherein the energy level of the power module is indicated by at least one of a voltage of the power module or a discharging current of the power module.
6. The method according to claim 1, wherein the power module comprises a battery pack having at least one cell, and wherein the energy level of the power module is at least one of: an energy level of the whole battery pack; or an energy level of at least one cell.
7. The method according to claim 1, further comprising: controlling the automatic moving device with the control module to start moving when the energy level of the power module is less than a preset energy level.
8. The method according to claim 1, further comprising: moving the automatic moving device toward the docking station when the absolute value of the rate of change of the energy level for the power module is less than the preset threshold value.
9. The method according to claim 8, further comprising controlling the automatic moving device with the control module to stop moving when the automatic moving device returns to the docking station.
10. The method according to claim 8, wherein moving the automatic moving device toward the docking station comprises: searching for a guidance signal related to a position of the docking station; and moving the automatic moving device toward the docking station according to the guidance signal.
11. The method according to claim 10, wherein the guidance signal is an electrical signal on a guide line and the guide line is connected to the docking station and wherein moving the automatic moving device toward the docking station further comprises: searching for the electrical signal; and moving the automatic moving device to the guide line and moving the automatic moving device toward the docking station along the guide line according to the electrical signal.
12. The method according to claim 1, wherein the automatic moving device is configured to perform a dust absorption task or a mowing task.
13. An automatic moving device, comprising: a driving module configured to move the automatic moving device; a power module configured to supply energy for the automatic moving device; a power-detecting unit configured to detect an energy level of the power module; and a control module configured to obtain a current energy level of the power module by the power-detecting unit and to control an operating status of the driving module, wherein the control module is configured to control the driving module to move the automatic moving device to return to the docking station, wherein the control module is configured to calculate a rate of change of the energy level of the power module based on the current energy level of the power module, and wherein the control module is configured to control the automatic moving device to stop moving when the absolute value of the rate of change of the energy level reaches or exceeds a preset threshold value.
14. The automatic moving device according to claim 13, wherein the control module is configured to set the preset threshold value.
15. The automatic moving device according to claim 14, further comprising: a type-identification unit configured to identify a type of the power module; and wherein the control module is configured to set the preset threshold value according to the signal transferred by the type-identification unit.
16. The automatic moving device according to claim 14, further comprising: a load-detecting unit configured to detect a load level of the power module; and wherein the control module is configured to set the preset threshold value according to a signal transferred by the load-detecting unit.
17. The automatic moving device according to claim 14, wherein: the power-detecting unit is configured to detect a discharging temperature of the power module; and the control module is configured to set the preset threshold value based on a signal transferred by the power-detecting unit.
18. The automatic moving device according to claim 13, wherein the rate of change of the energy level is first derivatives, second derivatives or higher derivatives of the energy level with respect to time.
19. The automatic moving device according to claim 13, wherein the energy level of the power module is indicated by at least one of a voltage of the power module or a discharging current of the power module.
20. The automatic moving device according to claim 13, wherein the power module comprises a battery pack having at least one cell, and wherein the energy level of the power module is at least one of: an energy level of the whole battery pack; or an energy level of at least one cell.
21. The automatic moving device according to claim 13, wherein the control module is configured to control the driving module to return the automatic moving device to the docking station when the control module determines that the current energy level of the power module is less than the preset energy level.
22. The automatic moving device according to claim 13, wherein the control module is configured to control the driving module to move the automatic moving device toward the docking station when the control module determines that the absolute value of the rate of change of the energy level for the power module is less than a preset threshold value.
23. The automatic moving device according to claim 22, wherein the control module is configured to control the driving module to stop moving when the control module determines that the automatic moving device has returned to the docking station.
24. The automatic moving device according to claim 22, further comprising: a guidance-signal-sensing unit, the guidance-signal-sensing unit configured to sense a guidance signal related to a position of the docking station; and wherein the control module is configured to control the driving module according to the guidance signal to drive the automatic moving device to move toward the docking station.
25. The automatic moving device according to claim 24, wherein: the guidance signal is the electrical signal on the guide line; the guide line is connected to the docking station; the guidance-signal-sensing signal-sensing unit is configured to sense the electrical signal; and the control module is configured to control the driving module to travel to the guide line and drive the automatic moving device to move toward the docking station along the guide line according to the sensed electrical signal.
26. The automatic moving device according to claim 13, further comprising a working module configured to perform a mowing task or a dust absorption task.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) The above technical problems solved by the invention, the technical scheme and beneficial effects can be obtained clearly by the following detailed description that can realize the better embodiment for the invention combined with the drawing descriptions.
(2) The same reference numerals in the drawings are used to represent the same or identical components.
(3)
(4)
(5)
(6)
(7)
(8)
(9)
DETAILED DESCRIPTION
(10) The detailed description and technical details of the invention, along with the accompanying drawings, are as follows. The drawings are only for reference and description and not for limitation of the invention.
(11)
(12) As shown in
(13) The control module 10 is a control center of the automatic moving device 2 and connects with other modules, receives messages from other modules and controls all kinds of actions or tasks such as performing moving, working, returning to the charging station 4 and charging, etc. The control module 10 includes processor 22, memory 24, timer 26, etc., and the detailed results and functions are described subsequently.
(14) The driving module 12 includes a motor located within the automatic moving device 2 and a wheel 8 (
(15) The working module 16 is used to perform detailed tasks by the automatic moving device 2. The working module 16 usually includes the working motor and working units driven by the working motor. If the automatic moving device 2 is a vacuum cleaner, the working unit has dust absorption parts for performing dust absorption task. These include a dust collection port, a fan, and a vacuum chamber. If the automatic moving device 2 is a lawn mower, then the working unit is a cutting part, which performs cutting for the working unit, such as an output shaft, cutter, blades, etc.
(16) The power module 14 supplies each module of the automatic moving device 2 with energy for working and includes a rechargeable battery pack and the charging terminals connecting with the battery pack. The charging terminal is used to match with the power terminal on the charging station 4 to connect onto the external power and supplement energy for the battery pack. The power sources module 14 can also be other rechargeable devices, such as rechargeable devices containing super capacitors. In this embodiment, the power module 14 is a battery pack with seven lithium battery cells, with 28 V rated voltage and 2000 mAh rated capacity.
(17) The power-detecting unit 18 connecting the power module 14 and the control module 10 is used to detect the energy levels of the battery pack in the power module 14 and sends a signal indicating the energy levels to the control module 10. In this implementation example, the power-detecting unit 18 detects the energy levels in the battery pack by detecting the voltage in the battery pack. For example, the power-detecting unit 18 is the voltage-detecting circuit of the battery pack and sends the signal indicating the voltage value to the control module 10 after detecting the voltage values of the battery pack. Certainly, the power-detecting unit 18 can detect the energy levels of the battery pack in a direct or indirect way, e.g., detect the residual capacity, discharging current, discharging time, discharging temperature of the battery pack. The power-detecting unit 18 can detect the energy levels of the whole battery pack, the energy levels of the battery cells and simultaneously detect both of them, in which the energy level of the battery cell can be the energy level of one battery cell, of some battery cells, or of each battery cell. All embodiments of the energy levels for the battery pack are well known by those knowledgeable in the art.
(18) The guidance signal-sensing unit 20 and the external guidance signal-transmitting unit of the automatic moving device 2 forms a returning guidance system, which is used to guide the automatic moving device 2 to return to the charging station 4.
(19) In this implementation example, the guidance signal-transmitting unit includes an electrical signal generator and the charging guide line 6. The electrical signal generator may be an electrical signal generator that separates with the automatic moving device 2, and an electrical signal generator that connects the charging guide line 6. The electrical signal generator sends electrical signal I to the charging guide line 6 as a guidance signal guiding the automatic moving device 2 to move toward the charging station 4, as shown in
(20) The returning guidance system can also have other implementations. The guidance signal-transmitting unit can be an ultrasonic transmitter, and the guidance signal-sensing unit 20 can be a corresponding ultrasonic sensing unit. The returning guidance system locates the position of the charging station 4 by ultrasonic waves and the guided automatic moving device 2 returns to the charging station 4. The guidance signal-transmitting unit can be an infrared transmitter, and the guidance signal-sensing unit 20 can be a corresponding infrared-sensing unit. The returning guidance system locates the position of the charging station 4 by infrared light and the guided automatic moving device 2 returns to the charging station 4. The guidance signal-transmitting unit can also be an image collector installed on the automatic moving device 2. The guidance signal-sensing unit is a pattern recognition device that determines the guidance signal related to the position of the charging station 4 according to image information collected by the image collector. The guidance signal-transmitting unit can also be a GPS satellite, and the guidance signal-sensing unit is a GPS chip installed on the automatic moving device 2, which determines the position of automatic moving device 2 relative to the charging station 4 to determine the guidance signal relative to the position of the charging station 4.
(21) Thanks to the collaboration of the above-described various parts, the invention realizes the returning charging and the over-discharging protection of the battery pack in the returning charging by means of the process described below or the methods.
(22) Referring to
(23) In the initial step S.sub.0, the automatic moving device 2 starts up or has been at work.
(24) Going to S.sub.2, the control module 10 monitors the energy level of the battery pack by the power-detecting unit 18. As mentioned previously, in this implementation example, the detection of power detects the voltage of the battery pack representing the energy levels of the battery pack and sends it to the control module 10.
(25) Then, in S.sub.4, the control module 10 determines that the energy level of the battery pack is greater than the preset energy level. The preset energy level is pre-stored in the memory 24 of the control module 10. The processor 22 of the control module 10 compares the preset energy level and the energy level of the battery pack. If the energy level of the battery pack is greater than the preset energy level described, go to S.sub.0, the automatic moving device 2 continues to work and does not perform other actions. Alternatively, if the energy level of the battery pack is not greater than the preset energy level described, go to S.sub.6 and start the action, which allows the automatic moving device 2 to return to the charging station. Specific to this implementation example, because the voltage of the battery pack expresses the energy level of the battery pack, the voltage stored in the memory 24 is a preset voltage value. The processor 22 determines degree relations between the preset energy level and the energy level of the detected battery level by comparing the degree relations between the voltage value of the battery pack and the preset voltage described. Additionally, in this implementation example, the process goes to S.sub.6 when the energy level of the battery pack equals the preset energy level, but it is practicable that the process goes to S.sub.2.
(26) After the control module 10 determines that the energy level of the battery pack is lower than the preset energy level, the automatic moving device 2 usually stops the operation of the working module 16 in the process of the returning to save energy.
(27) After going to S.sub.6, the automatic moving device 2 starts the returning action. For example, it starts returning to the charging station 4. The step following S.sub.6 is S.sub.8; the automatic moving device 2 sets a preset length of time and starts timing after starting the returning action. S.sub.6 is before S.sub.8 in this procedure. The technicians in this field can understand that there is no strict order between S.sub.6 and S.sub.8 and their order can be exchanged or it is considered that they can be performed simultaneously.
(28) The preset length of time described is a fixed value, which is pre-stored in the memory 24, such as 20 minutes. In S.sub.8, the processor 22 reads the preset length of time from the memory 24 and commands the timer 26 to start timing according to the preset length of time.
(29) In this implementation example, provided that the energy level of the battery pack is less than or equal to the preset energy level, regardless of the difference between this energy level and the preset energy level, the preset length of time is certain. However, in other optional embodiments, the preset length of time can also be a changing value and the control module 10 can set the preset length of time according to the monitored energy level of the battery pack. The control module 10 can calculate the preset length of time based on the difference between the detected energy level and the preset energy level, or directly based on the energy level of the battery pack, and there is no essential distinction between both. In this implementation example, because the voltage of the battery pack expresses the energy level of the battery pack, practically, the control module 10 can set the preset length of time according to the voltage values of the battery pack. It can set the preset length of time based on the difference between the detected voltage and the preset voltage value. For example, if the detected battery pack voltage value is 22 V and the preset voltage value is 23 V, the preset length of time is 20 minutes. If the detected battery pack voltage value is 21 V, the preset length of time is 18 minutes accordingly, and so on. It is easy to think that the corresponding relation between the preset length of time and the detected voltage value or the aforementioned difference can be obtained by a formula and can be directly set by the comparison table pre-stored in the memory 22.
(30) After starting the returning action, the automatic moving device 2 goes to S.sub.10 that is, performing returning action and returning to the charging station. The automatic moving device 2 searches the guidance signal related to the position of the charging station 4 by the guidance signal-sensing unit 20 and moves to the charging station 4 according to the guidance signal. As mentioned previously, the guidance signal-sensing unit 20 moves toward the charging guide line by sensing the surrounding magnetic signal generated by the electrical signal on the charging guide line 6, and then moves toward the charging station 4 along the charging guide line 6.
(31) After performing S.sub.10, the control module 10 determines whether the automatic moving device 2 successfully returns to the charging station 4, in S.sub.12. It may then determine that the charging terminals on the automatic moving device 2 are connected with the power terminal on the charging station 4. Usually, the determination is realized by monitoring that the charging terminals described receive the external voltages or signal. The determination can be performed by other ways such as position sensor, crash sensor. If the result is Yes, that is, the automatic device 2 returns the charging station 4, go to S.sub.14, the control module 10 controls the automatic moving device 2 to stop moving and starts charging. If the result is No, go to S.sub.16.
(32) S.sub.16 determines whether the length of time has been reached. If the determined result of S.sub.16 is No, return to S.sub.10 and continue to perform the action of returning to the charging station. If the result is Yes and the preset length of time has reached, go to S.sub.18 and the automatic moving device 2 stops moving. The control module 10 controls the driving module 12 to stop working.
(33) In the first working process, whenever the automatic moving device 2 successfully returns to the charging station 4, it stops moving after the preset length of time. That is, if the automatic moving device 2 returns to the charging station 4 within the preset length of time, it will stop moving in the charging station 4 and perform charging. If the automatic moving device 2 cannot return to the charging station 4 within the preset length of time, it will also stop moving. This working process avoids both the automatic moving device 2 continuously searching for the charging station 4 when it cannot successfully return and damage due to over-discharging of the battery pack.
(34) When the determined result of S.sub.16 is Yes, the control module 10 may also control the automatic moving device 2 to send a charging reminder signal to remind users to manually return the automatic moving device 2 to the charging station 4. The charging reminder signal can be graphic information displayed on the display panel of the automatic moving device 2, a special alarm sound signal, or information on other devices for the remote wireless from the user, such as short messages or other reminders sent to the users' mobile phone via a mobile network, etc.
(35) By the first working process as described above, the automatic moving device 2 can start returning in good time to power-up and work, according to the energy levels of the battery pack as well as perform the over-discharging protection on the battery pack during the returning.
(36) The following introduces the second working process of this invention with the help of
(37) In the initial step S.sub.1, the automatic moving device 2 starts up, i.e., it is recovered from power off or sleep state to power-on state. Then go to S.sub.3, the power-detecting unit 18 detects the initial energy level of the battery pack and sends it to the control module 10.
(38) The initial energy level of the battery pack can be detected when the main power-consumption parts of the automatic moving device 2, the driving module 12 and working module 16 have not worked. In this implementation example, because it detects the energy level of the battery pack by means of measuring voltage, the automatic moving device 2 detects the initial energy level of the battery pack at work or under normal loads to prevent virtual-high voltage values of the battery pack without working. The automatic moving device 2 may first start the driving module 12 and working module 16 for a few seconds at start-up, detect the voltage values of the battery pack and send the values to the control module 10.
(39) After the control module 10 receives signals representing the initial energy level of the battery pack, perform S.sub.5 to determine that if the energy level of the battery pack is greater than the first preset energy level. If the initial energy level of the battery pack is greater than the preset energy level, go to S.sub.9. The control module 10 controls the automatic moving device 2 for working. For example, the driving module 12 drives and the working module 16 performs the preset task.
(40) Alternatively, if the initial energy level of the battery pack is not greater than the preset energy level, go to S.sub.7 and continuously determine that the initial energy level of the battery pack is greater than the second energy level and the second preset energy level is less than the first preset energy level.
(41) If the determined result of S.sub.7 is No and the initial energy level of the battery pack is not greater than the second preset energy level, the process jumps to S.sub.27. The control module 10 controls the automatic moving device 2 to stop moving and at this time the automatic moving device 2 cannot usually perform other working tasks. If the determined result of S.sub.7 is Yes and the initial energy level of the battery pack is greater than the second preset energy level, go to S.sub.15, the automatic moving device 2 starts returning action.
(42) In S.sub.5 and S.sub.7, the detailed determination procedure of the initial energy level is similar to the first working mode. Because the voltage of the battery pack is detected by the power-detecting unit, the initial energy level, the first preset energy level and the second energy level are indicated by the initial voltage value of the battery pack, the first preset voltage value and the second preset voltage value. The first preset voltage value and the second preset voltage value are pre-stored in the memory 24 of the control module 10 and the processor 22 of the control module 10, which determines the relation between the initial energy level of the battery pack and the first preset voltage value or the second preset voltage value.
(43) The automatic moving device 2 has three following actions based on the initial energy levels of the battery pack at start-up by the above process setting. If the initial energy level of the battery pack is greater than the first preset energy level, it indicates that the initial energy of the battery pack is enough, the automatic moving device 2 performs the first follow-up action, then, go to S.sub.9 for normal start. The control module 10 commands the automatic moving device 2 to perform working, i.e., performing the preset tasks or other commands received. If the initial energy level of the battery pack is between the first preset energy level and the second preset energy level, i.e., less than the first preset energy level and greater than the second preset energy level, this indicates that the initial energy of the battery pack is not enough and requires supplemental energy. The automatic moving device 2 will then perform the second follow-up action. Go to S.sub.15 for performing the action of returning to the charging station 4. If the initial energy level of the battery pack is less than or equal to the second preset energy level, indicating the initial energy of the battery pack has a serious shortage, it is not proper to perform work and the actions of returning to the charging station 4. Therefore, the automatic moving device 2 performs the third follow-up action and performs S.sub.27, and the control module 10 commands the automatic moving device 2 to stop moving. This can effectively avoid starting the returning process when the energy of the battery pack is too low, and thus avoid damages due to over-discharging of the battery pack.
(44) When performing the first follow-up actions, the automatic moving device 2 goes from S.sub.5 to S.sub.15, and then goes to S.sub.27 according to the follow-up procedure of S.sub.15. Starting from S.sub.9 through S.sub.27, the working process of the automatic moving device 2 is in general accord with the first working procedure described above.
(45) After S.sub.9, the automatic moving device 2 goes to S.sub.11 and monitors the energy level of the battery pack. In S.sub.13, it is determined that the energy level of the battery pack is greater than the third preset energy level and the third preset energy level is less than or equal to the first preset energy level but is greater than the second preset energy level. The third preset energy level is indicated by voltage value and is pre-stored in the memory 24. If the determined result of S.sub.13 is Yes, return to S.sub.9 to continue to perform working; if the determined result is No, go to S.sub.15 to start the returning action. In S.sub.17, the automatic moving device 2 sets a preset length of time and starts timing from starting the returning actions via the timer 26; after S.sub.17, the process goes to S.sub.19 and the automatic moving device 2 performs the returning action. After S.sub.19, in S.sub.21, the control module 10 determines that the automatic moving device 2 has returned to the charging station 4. If the result is Yes, go to S.sub.23, the automatic moving device 2 stops moving and performs charging. If the result is No, go to S.sub.25, and then determine that the action for performing the returning action has reached the preset length of time. If the determined result of S.sub.25 is No, the process returns to S.sub.19 to continue to perform the returning action. If the determined result of S.sub.25 is Yes, go to S.sub.27, the automatic moving device 2 stops moving.
(46) When performing the second follow-up actions, the automatic moving device 2 goes from S.sub.7 to S.sub.15, and then goes to S.sub.27 according to the follow-up procedure of S.sub.15. In this case, it is particularly advantageous to set the preset length of time according to the initial energy level of the battery pack or the initial voltage value detected in S.sub.3. In the first working process, if the energy of the battery pack detected in the working process and the energy level of the battery pack are reduced gradually from the high point, the energy level of the battery pack usually equals to or is slightly lower than the preset energy level when the automatic moving device 2 starts returning. Therefore, it is practicable to set a fixed preset length of time. However, as described in the second working process, in the process starting from the startup action, the energy level may be much lower than the first preset energy level due to self-discharging of the battery pack. At this time, the preset working time can be set according to the initial energy level or the initial voltage of the battery pack or the real safe operating item of the battery pack to avoid damages due to over-discharging of the battery pack.
(47) Starting from S.sub.15, the process of the automatic moving device 2 is the same as that of the process of the first follow-up action starting from S.sub.15, i.e., starting returning and sets one preset length of time and starts timing; if the preset length of time has reached, stops moving.
(48) Similar with the first working process, in the returning relative process of the first follow-up action and the second follow-up action, whenever the automatic moving device 2 returns to the charging station 4 successfully, it stops moving at the preset length of time. That is, if the automatic moving device 2 returns to the charging station 4 within the preset length of time, it will stop moving in the charging station 4 and perform charging. If the automatic moving device 2 cannot return to the charging station 4 within the preset length of time, it will be also stop moving. This working process avoids both the automatic moving device 2 continuously searching for the charging station 4 when it cannot successfully return and damages due to over-discharging of the battery pack.
(49) When performing the third follow-up action, the automatic moving device 2 directly goes to S.sub.27, stops moving and waits for the user to perform charging with manual assistance. Similar with the first working process described above, the automatic moving device 2 can also send a charging reminder signal.
(50) By the two working processes described above, the automatic moving device 2 in this invention can automatically return to the charging station for charging in case of insufficient energy, avoiding damages due to discharging of the battery pack in the returning.
(51) Referring to
(52) The load-detecting unit 27 connects the power module 14 and the control module 10 and is used to detect the load levels of the power module 14, i.e., the consumption state of the automatic moving device 2 of the energy of the power module 14. The load levels of power module 14 are identified by detecting the discharging current, discharging voltage, discharging temperature of the power module 14. Specific to this implementation, the load-detecting unit 27 detects the discharging currents of the power module 14 and transfers the detected discharging current values to the control module 10 in real time, which is easy for the control module 10 to perform the corresponding process and control according to the transferred signal.
(53) The type-identification unit 28 connects the power module 14 and the control module 10 and can be used for identifying the type of the power module 14, such as the chemical type, voltage type, etc., of the power module 14. The type-identification unit 28 can set identification resistance within the power module 14 and can also be identification circuits set inside or outside the power module 14. Specific to this implementation, the type-identification unit 28 is the identification resistance set within the power module 14, and the control module 10 can obtain the type of the power module 14 by obtaining the resistance values of the type-identification unit 28.
(54) Thanks to the collaboration of the above-described various parts, the invention realizes the returning charging and the over-discharging protection of the battery pack in the returning charging by means of the process described below or the methods.
(55) The workflow diagram shown in
(56) In the initial step S.sub.0A, the automatic moving device 2 is in the start-up state, at this time the automatic moving device 2 has not started performing works.
(57) Going to S.sub.1A, the control module 10 monitors the energy level of the battery pack by the power-detecting unit 18. The energy level of the battery pack can be residual capacity, discharging voltage, discharging current, discharging time, discharging temperature, etc., of the battery pack. The energy level of the battery pack can be the energy level of the whole battery pack, the energy level of one battery cell, the energy level of some battery cells, the energy level of every battery cell or a combination of the energy level described above. As mentioned previously, in this implementation example, the power-detecting unit 18 detects the voltage of the battery pack representing the energy levels of the whole battery pack and sends it to the control module 10.
(58) After S.sub.1A, go to S.sub.2A, wherein the control module 10 determines that the energy level of the power module 14 obtained by the power-detecting unit 18 is lower than the first preset energy level. The first preset energy level is pre-stored in the memory 24 of the control module 10. The processor 22 of the control module 10 compares the energy level of the first preset energy level and of the detected power module 14. If the energy level of power source is lower than the first preset energy level, go to S.sub.6A. In S.sub.6A, the control module 10 controls the automatic moving device 2 to start returning. If the energy level of the power module 14 is not lower than the first preset energy level, go to S.sub.3A. As mentioned previously, in this implementation example, because the energy level of the power module 14 is indicated by the whole battery pack voltage, the one stored in the memory 24 is the first preset voltage value. The processor 22 determines the degree relations between the first preset energy level and the detected energy level of the power module 14 by comparing the degree relations between the whole battery pack voltage and the first preset voltage value described. In this implementation example, when the energy level of the power module 14 equals to the first preset energy level, go to S.sub.3A, but at this time it is practicable if the process goes to S.sub.6A.
(59) In S.sub.3A, the control module 10 controls the working module 16 to start working, thus, performing the corresponding works, such as dust absorption tasks or mowing tasks. After S.sub.3A, go to S.sub.4A. In S.sub.4A, the same work is performed as S.sub.1A, that is, the control module 10 monitors the energy level of the power module 14, i.e., the whole battery pack voltage by the power-detecting unit 18.
(60) After S.sub.4A, go to S.sub.5A, wherein the control module 10 determines that the energy level of the power module 14 is lower than the second preset energy level. The second preset energy level is pre-stored in the memory 24 of the control module 10. The processor 22 of the control module 10 compares the energy level of the second preset energy level and the detected energy level of the power module 14. If the energy level of the power module 14 is not lower than the second preset energy level described, go to S.sub.3A. The automatic moving device 2 continues to work and does not perform other actions. Alternatively, if the energy level of the power source is lower than the second preset energy level described, go to S.sub.6A, start the action of allowing the automatic moving device 2 to return the charging station. In this implementation example, because the whole battery pack voltage indicates the energy level of the power module 14, the one stored in the memory 24 is the second preset voltage value. The processor 22 determines the degree relations between the second preset energy level and the detected energy level of the power module 14 by comparing the degree relations between the whole battery pack voltage and the first preset voltage value described. In this implementation example, when the energy level of the power module 14 equals to the second preset energy level, go to S.sub.3A, but at this time it is practicable if the process goes to S.sub.6A.
(61) As mentioned previously, the memory 24 of the control module 10 stores the first preset energy level and the second preset energy level. The first preset energy level is in the condition that the control module 10 determines that it controls the automatic moving device 2 to start the returning before the working module 16 of the automatic moving device 2 performs the work. The second preset energy level is in the condition that the control module 10 determines that it controls the automatic moving device 2 to start the returning before the working module 16 of the automatic moving device performs the work. The first preset energy level can be the same as the second preset energy level and can be different. If they are the same, the memory 24 of the control module 10 only requires storing one preset energy level. In this case, in S.sub.2A and S.sub.5A, the first preset energy level is used as comparing with the energy level of the detected power module 14 together with the second preset energy level, which is the same preset energy level. The first preset energy level may be different from the second preset energy level. Memory 24 of the control module 10 may store the first preset energy level and the second preset energy level according to different load levels in the power module 14. Because the working module 16 has not started performing the work when the processor 22 compares the energy level of the power module 14 with the first preset energy level, the energy consumption of the automatic moving device 2 on the power module 14 is less and the load level of the power module 14 is less. When the processor 22 compares the energy level of the power module 14 with the second preset energy level, the working module 16 has started to perform working. The energy consumption of the automatic moving device 2 on the power module 14 is more. The load level of the power module 14 is also larger. Therefore, the first preset energy level stored by the memory 24 of the control module 10 is not higher than the energy level of the second preset energy level. When the first preset energy level and the second preset energy level is set, it is considered that the residual energy level of the power module 14 is enough to support the automatic moving device 2 to return to the charging station. In this implementation, the energy required by the automatic moving device 2 for returning to the charging station is about 100 mAh, but the residual energy retained in the power module 14 is 200 mAh when setting the first preset energy level and the second preset energy level to improve the reliability. In an implementation, the power module 14 is a lithium battery pack with a rated voltage of 28 V and 2000 mAh capacity, which has an energy level that goes through the complete voltage-reaction power module 14 for the battery pack. It is obtained from tests that the residual capacity is 200 mAh and the voltage of the whole battery pack is about 24.5 V when the loads are not applied on the battery pack; the residual capacity is 200 mAh, and the voltage of the whole battery pack is about 23 V when about 0.6 A loads are applied. Therefore, the memory 24 of the control module 10 stores the preset voltage value and the second preset voltage value with the two different values, where the first preset voltage is 24.5 V and the second preset voltage is 23 V. Thus, it is clear that, in this implementation, the first preset voltage value and the second preset voltage value are fixed values and the first preset voltage value is lower than the second preset voltage value.
(62) From S.sub.0A described above to S.sub.5A,
(63) After the control module 10 determines that the energy level of the power module 14 is lower than the preset energy level, the automatic moving device 2 usually stops the operation of the working module 16 in the process of the returning to save energy.
(64) After going to S.sub.6A, the automatic moving device 2 starts the returning action, i.e., starts returning to the charging station 4. The step after S.sub.6A is S.sub.7A. In S.sub.7A, the same actions are performed as S.sub.1A or S.sub.4A, that is, the control module 10 monitors the energy level of the power module 14 via the power-detecting unit 18.
(65) After S.sub.7A, the automatic moving device 2 goes to S.sub.8A; the control module 10 obtains the energy level of the current power module 14 through power-detecting unit 18 and calculates the changing rate of the energy level according to the current energy level. It may be observed after long-term research that the changing of the energy level is smooth when the power module 14 is in the initial period of discharging, i.e., the residual power level is higher. The changing of the energy level changes dramatically at the end of discharging, i.e., when the residual power level is very low. The changing rates of the energy level in the two stages have a very clear distinction. Therefore, the stage of discharging the power module 14 is obtained by calculating the changing rate of the energy level. Stopping further discharging of the power module 14 may prevent damage to the power module 14 due to over-discharging.
(66) To further describe the above characteristics; take the changing curve of the voltage in the discharging process of the power module 14 as an example together with
(67) With reference to
(68) In this implementation, the control module 10 sets the preset threshold based on the type, load levels and discharging temperature of the power module 14. Specifically, the control module 10 detects discharging current of the battery pack by the load-detecting unit 27 and it is 0.6 A to 1 A in this implementation. At this time, the type-identification unit 28 detects the type of the battery pack and it is a lithium battery in this implementation. Additionally, the control module 10 detects the temperature of the power module 14, the operating mode of the temperature-detecting unit is well known by the technicians, for simplicity, it is not shown in the figure. After knowing the discharging current, discharging temperature and type in the battery pack, the preset threshold 0.02 V/s is indicated by the threshold of the memory 24 stored in the control module 10 via the real-time query.
(69) Because in the implementation, the discharging current of power module 14 is detected by the load-detecting unit 27, and the discharging current can also be parameters representing the energy level of power module 14. When the energy level is indicated by the discharging current and the power-detecting unit 18 is set as the discharging current of the power module 14, which can be detected, the function of the load-detecting unit 27 can also be realized by the power-detecting unit 18 directly. Additionally, the function of the temperature-detecting unit can also be completed by the power-detecting unit 18 directly.
(70) After S.sub.9A, the automatic moving device 2 goes to S.sub.10A. For example, it drives the automatic moving device 2 to move toward the charging station 4 to return to the charging station 4. The automatic moving device 2 searches for the guidance signal related to the position of the charging station 4 by the guidance signal-sensing unit 20 and moves to the charging station 4 according to the guidance signal. As mentioned previously, the guidance signal-sensing unit 20 moves toward the charging guide line 6 by sensing the surrounding magnetic signal generated by the electrical signal on the charging guide line 6, then moves toward the charging station along the charging guide line 6.
(71) After performing S.sub.10A, go to S.sub.12A. The control module 10 determines that the automatic moving device 2 successfully returns to the charging station 4 and may determine that the charging terminals on the automatic moving device 2 are connected with the power terminal on the charging station 4. Usually, the determination is realized by monitoring that the charging terminals described have received the external voltages or signal, and the determination can be performed by other ways such as a position sensor, a crash sensor, etc. If the result is Yes and the automatic device 2 returns the charging station 4, go to S.sub.14A, wherein the control module 10 controls the automatic moving device 2 to stop moving and start charging. If the result is No, go to S.sub.16A.
(72) S.sub.16A determines if the absolute value of the changing rate of the energy level of the battery pack reaches or exceeds the preset threshold. If the result of S.sub.16A is No, i.e., the absolute value of the changing rate of energy level for the battery pack is lower than the preset threshold, return to S.sub.10A and continue to perform the action for returning to the charging station 4. If the result is Yes, i.e., the changing rate of the energy level for the battery pack reaches or exceeds the preset threshold, go to S.sub.18A. In S.sub.18A, the automatic moving device 2 stops moving. The control module 10 may control the driving module 12 to stop working.
(73) In the working process shown in
(74) When the determined result of S.sub.16A is Yes, the control module 10 may also control the automatic moving device 2 to send a charging reminder signal to remind users that the automatic moving device 2 will be returning to the charging station 4 with manual assistance. The charging reminder signal can be graphic information displayed on the display panel of the automatic moving device 2, a special alarm sound signal, or information on other devices such as short messages or other reminders sent to the users' mobile phone via a mobile network, etc.
(75) By the working process as described above, the automatic moving device 2 can start returning in good time to power-up and work, according to the energy levels of the battery pack as well as perform the over-discharging protection on the battery pack during the returning.
(76) The chronological description method is used in all steps for describing this procedure. The order of the described method does not represent an order that must be followed strictly and the steps can be adjusted properly as needed. For example, S.sub.8A can be set after S.sub.9A. S.sub.10A can also be between S.sub.6A and S.sub.7A. That is, based on the principle of the invention, the technicians in this field can perform proper adjustment on the procedures in this process, which can realize the effect of this invention.
(77) The invention is suitable for the automatic moving device 2 that will be returning to the charging station 4 that performs charging and is also suitable for the automatic moving device 2 of the returning working station or other specific devices. Determining that it returns to the working station or other specific device can be realized by the same way for determining that it returns to the charging station, and also by the automatic moving device 2 reaching the working station or within a specific range of other specific devices, the automatic moving device 2, working station or other specific device send wireless signals for determination mutually.