Position detection method and device, storage medium, program product and robot system
By using delay processing and load signal threshold comparison, the problem of false detection caused by oxidation of robot charging components was solved, thus improving the accuracy and efficiency of in-situ detection.
Patent Information
- Application Number
- CN202310518761.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2023-05-10
- Publication Date
- 2024-11-12
AI Technical Summary
In existing technologies, robot in-situ detection signals are prone to poor contact due to oxidation of charging components, leading to false detections and affecting work efficiency.
By delaying the processing of changes in the robot's presence signal and comparing it with the current and voltage thresholds of the base station load signal, the system ensures that the signal is stable before sending the absence signal, thereby reducing false detections.
This improves the accuracy and efficiency of robot in-situ detection and prevents operational interruptions caused by false detections.
Smart Images

Figure CN118924191A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robot technology, and in particular to a position detection method, device, storage medium, program product and robot system. Background Art
[0002] In the related art, for wheeled robots such as sweeping robots and mopping robots, they determine whether the robot is in place, that is, determine whether the robot is in a base station, through a detection signal of the current position.
[0003] The detection signal of the current position is obtained through the contact between the second charging element of the robot and the first charging element of the base station. When the second charging element is in poor contact with the first charging element, the detection signal of the current position may frequently switch between "in place" and "out of place", resulting in false detection that the robot is not in place even if the robot has not left the base station, affecting the working efficiency of the robot. Summary of the invention
[0004] The present invention aims to solve at least one of the technical problems existing in the prior art or related art.
[0005] To this end, a first aspect of the present invention provides a position detection method.
[0006] A second aspect of the present invention provides a position detection device.
[0007] A third aspect of the present invention provides a position detection device.
[0008] A fourth aspect of the present invention provides a readable storage medium.
[0009] A fifth aspect of the present invention provides a computer program product.
[0010] A sixth aspect of the present invention provides a robot system.
[0011] In view of this, a first aspect of the present invention provides a position detection method, which is applied to a robot system. The robot system includes a base station and a robot. The base station includes a first charging element, and the robot includes a second charging element. The position detection method includes:
[0012] A detection signal of the robot at a current position is obtained, wherein the detection signal of the current position includes a first signal and a second signal, the first signal is used to indicate that the second charging element is in contact with the first charging element, and the second signal is used to indicate that the second charging element is separated from the first charging element; when it is detected that the detection signal of the current position changes from the first signal to the second signal, timing is started; after the timing duration reaches a preset duration, if the detection signal of the current position obtained is still the second signal, the second signal is sent to the robot.
[0013] In this technical solution, the robot system may be a cleaning robot system, such as a mopping robot system or a sweeping and mopping robot system, etc. The robot system includes a base station and a robot, wherein the base station is used to charge the robot, collect dust collected by the robot, and clean the cleaning components of the robot.
[0014] When the robot is performing a cleaning operation or after completing a cleaning operation, the robot will return to the base station to wait and perform operations such as cleaning cleaning components, collecting dust, and cutting hair wrapped around the cleaning brush. The above operations require that the robot is located at a corresponding position in the base station, so the position of the robot needs to be detected.
[0015] Specifically, the base station obtains a detection signal of the current position of the robot. The detection signal of the current position specifically includes two signals, namely a first signal and a second signal. The first signal is a signal that the robot is "in position". When the robot is in position, the second charging element of the robot is in contact with the first charging element of the base station. At this time, the base station can charge the robot, and can also perform operations such as cleaning cleaning components, collecting dust, and cutting hair wrapped around the cleaning brush.
[0016] The second robot is a situation where the robot is “not in place”. When the robot is not in place, it means that the second charging element of the robot is separated from the first charging element of the base station. When the robot is not in place, some operations on the robot may be terminated.
[0017] In the related art, the presence detection is performed based on the electrical signal when the second charging element of the robot contacts the first charging element of the base station. In some cases, such as oxidation of the surface of the second charging element of the robot or the first charging element of the base station, the second charging element of the robot and the first charging element of the base station may be in poor contact, which will cause the circuit between the second charging element and the first charging element to be disconnected instantly. When the robot does not leave the base station, the detection signal of the current position will suddenly change from "in position" to "out of position", so even if the robot does not leave the base station, it will be judged that the robot is not in position, which affects the working efficiency of the robot.
[0018] The first charging element is specifically a spring of the base station, and the second charging element is specifically a contact point of the robot.
[0019] In response to the above situation, when the present application detects that the position signal changes from the first signal indicating that the robot is in place to the second signal indicating that the robot is not in place, the signal that the robot is not in place will not be reported immediately, but a preset delay period will be made. After the preset delay period, if the detection signal of the current position is still the second signal, the second signal indicating that the robot is not in place will be reported to the robot.
[0020] If the detection signal at the current position changes back to the first signal after a preset delay period, the detected second signal is determined to be a false detection, and the falsely detected second signal is not reported, to prevent the robot's operations such as cleaning cleaning components, collecting dust, and cutting hair wrapped around the cleaning brush from being interrupted by false detection due to false detection of signals, thereby ensuring the robot's work efficiency.
[0021] In the embodiment of the present invention, when the robot's in-place signal suddenly changes from in-place to out-of-place, the out-of-place signal is delayed, and the out-of-place signal is sent to the robot only when the detection signal of the current position after the delay is still out-of-place, thereby ensuring the reliability of position detection and improving the working efficiency of the robot.
[0022] In addition, the position detection method in the above technical solution provided by the present invention may also have the following additional technical features:
[0023] In the above technical solution, the step of obtaining the detection signal of the current position includes: obtaining the load signal of the base station; determining the comparison result between the signal value of the load signal and the threshold; and determining whether the detection signal of the current position is the first signal or the second signal according to the comparison result.
[0024] In this technical solution, the load signal of the base station is detected, and the signal value of the detected load signal is compared with a preset threshold value. The robot is judged to be in place or not according to the comparison result, specifically, it is judged whether the detection signal is the first signal or the second signal.
[0025] Specifically, the base station can charge the robot. When the robot is not in place, the load of the base station is fixed, so the signal value of the load signal is also in a relatively stable range. When the robot is in place, the second charging element of the robot is in contact with the first charging element of the base station. At this time, a loop is formed between the second charging element and the first charging element, and the load of the base station will change. Therefore, according to the load signal of the base station, it can be accurately determined whether the second charging element of the robot is in contact with the first charging element of the base station, and it can also be accurately determined whether the robot is in place.
[0026] The embodiment of the present invention can accurately identify whether the robot is in place by comparing the signal value of the load signal of the base station with the threshold value, thereby improving the accuracy of the robot's in-place detection.
[0027] In any of the above technical solutions, the signal value includes a load current value and a load voltage value, and the threshold includes a current threshold and a voltage threshold;
[0028] The step of determining whether the detection signal of the current position is the first signal or the second signal according to the comparison result includes: when the load current value is less than or equal to the current threshold, and the load voltage value is less than or equal to the voltage threshold, determining that the detection signal of the current position is the first signal; when the load current value is greater than the current threshold, and the load voltage value is greater than the voltage threshold, determining that the detection signal of the current position is the second signal.
[0029] In this technical solution, the signal value of the load signal of the base station specifically includes a load current value and a load voltage value, and correspondingly, the threshold value specifically includes a current threshold value and a voltage threshold value.
[0030] Specifically, when it is detected that the load current value is greater than the current threshold and the load voltage value is greater than the voltage threshold, it is determined that the second charging element of the robot is not connected to the first charging element, and the robot is not in place at this time.
[0031] When it is detected that the load current value is less than or equal to the current threshold, and at the same time the load voltage value is less than or equal to the voltage threshold, it is determined that the second charging element of the robot is connected to the first charging element, and the robot is in place.
[0032] The embodiment of the present invention can accurately identify whether the robot is in place by comparing the load current value of the base station with the current threshold, and the load voltage value of the base station with the voltage threshold, thereby improving the accuracy of the robot's in-place detection.
[0033] In any of the above technical solutions, the load signal includes N consecutive signal values, where N is a positive integer; and the step of determining the comparison result between the signal value of the load signal and the threshold value includes:
[0034] Determine N comparison results of N signal values and threshold values respectively; determine the detection signal of the current position as the first signal or the second signal according to the comparison results, comprising: when the number of comparison results satisfying the preset condition corresponding to the first signal among the N comparison results is greater than or equal to the number of comparison results satisfying the preset condition corresponding to the second signal, determine the detection signal of the current position as the first signal;
[0035] When, among the N comparison results, the number of comparison results satisfying the preset condition corresponding to the first signal is less than the number of comparison results satisfying the preset condition corresponding to the second signal, it is determined that the detection signal of the current position is the second signal.
[0036] In this technical solution, filtering processing of the detection signal of the current position is added. Specifically, when collecting the load signal of the base station, N signal values of the load signal are continuously collected according to a preset collection period, and the comparison result of each signal value in the N signal values and the signal threshold is determined respectively, and among the N comparison results obtained by comparison, the number of comparison results that meet the preset conditions of the first signal and the number of comparison results that meet the preset conditions of the second signal are determined.
[0037] Exemplarily, the N signal values may be signal values collected within a certain period of time, such as signal values collected within 1.5 seconds.
[0038] If the number of comparison results satisfying the preset condition corresponding to the first signal is greater than or equal to the number of comparison results satisfying the preset condition of the second signal, it is determined that the detection signal at the current position is specifically the first signal and the robot is in place.
[0039] Similarly, if the number of comparison results that satisfy the preset condition corresponding to the second signal is greater than the number of comparison results that satisfy the preset condition of the first signal, it is determined that the detection signal at the current position is specifically the second signal and the robot is not in place.
[0040] Specifically, the N signal values include N current values and N voltage values corresponding to the N current values one by one. Each current value and the corresponding voltage value form a set of data, so there are N sets of data in total.
[0041] When a group of data satisfies that the current value is less than or equal to the current threshold, and the voltage value is less than or equal to the voltage threshold, it is determined that the group of data, that is, the signal value, satisfies the preset condition corresponding to the first signal.
[0042] When a group of data satisfies that the current value is greater than the current threshold value and the voltage value is greater than the voltage threshold value, it is determined that the group of data, that is, the signal value, satisfies the preset condition corresponding to the second signal.
[0043] Assume that N=40, that is, among the 40 signal values obtained, there are greater than or equal to 20 signal values that meet the preset conditions corresponding to the first signal, then the detection signal at the current position is determined to be the first signal. If there are greater than or equal to 21 signal values that meet the preset conditions corresponding to the second signal, then the current detection signal is determined to be the second signal.
[0044] The embodiment of the present application filters the load signal of the base station for a certain period of time, and determines whether the robot is in place based on the side with a larger proportion of judgment results among the N collected signal values. This can effectively reduce false detections caused by poor contact between the first charging element and the second charging element, and improve the reliability and accuracy of the robot's in-place detection.
[0045] In any of the above technical solutions, the value range of the current threshold is: greater than or equal to 20ma, and less than or equal to 40ma; the value range of the voltage threshold is: greater than or equal to 2.1V, and less than or equal to 4V.
[0046] In this technical solution, assuming the current threshold is A, 20ma≤A≤40ma is satisfied.
[0047] Exemplarily, the current threshold is 28 mA.
[0048] Exemplarily, the current threshold is 30 mA.
[0049] Assuming the voltage threshold is U, then 2.1V≤U≤4V is satisfied.
[0050] Exemplarily, the voltage threshold is 3.1V.
[0051] Exemplarily, the voltage threshold is 2.8V.
[0052] When the collected load current is less than or equal to the current threshold, and the collected load voltage is less than or equal to the voltage threshold, it is determined that the collected detection signal of the current position of the robot is specifically the first signal. When the collected load current is greater than the current threshold, and the collected load voltage is greater than the voltage threshold, it is determined that the collected detection signal of the current position of the robot is specifically the first signal.
[0053] The embodiment of the present invention can accurately identify whether the spring clip of the base station outputs a power signal, that is, whether the contact of the robot is in contact with the spring clip of the base station, by comparing the load current and load voltage of the base station with the corresponding current threshold and voltage threshold, thereby judging whether the robot is in place and improving the accuracy of the robot's in-place detection.
[0054] In any of the above technical solutions, the value range of N is: 25≤N≤55.
[0055] In this technical solution, when collecting the load signal of the base station, N signal values of the load signal are continuously collected according to a preset collection period, where N is an integer greater than or equal to 25 and less than or equal to 55.
[0056] Exemplarily, N=45.
[0057] Exemplarily, N=40.
[0058] Taking N=40 as an example, within 1.5 seconds, a signal value is collected every 37.5ms, and a total of 40 signal values are collected within 1.5 seconds. If there are greater than or equal to 20 signal values among the 40 signal values that meet the preset conditions corresponding to the first signal, then the detection signal at the current position is determined to be the first signal. If there are greater than or equal to 21 signal values that meet the preset conditions corresponding to the second signal, then the current detection signal is determined to be the second signal.
[0059] The embodiment of the present invention collects N continuous signal values, determines the final position detection result based on the comparison result of the number of first signals and the number of second signals among the N signal values, and by appropriately setting the number of signal values, can improve the detection accuracy and reliability while ensuring the timeliness of the position detection result.
[0060] In any of the above technical solutions, the robot also includes running wheels; after the step of sending a second signal to the robot, the position detection method also includes: when the robot's working mode is the first mode and no lifting signal of the running wheel is detected, controlling the robot to move in a direction close to the first charging element for a preset number of times.
[0061] In this technical solution, the robot is specifically a wheeled robot, and the robot includes running wheels, which are used to drive the robot to move. A sensor is provided on the running wheel to detect whether the running wheel of the robot is lifted. When the running wheel is lifted, the sensor generates a lifting signal, which is used to indicate that the running wheel of the robot is off the ground, that is, the user manually lifts the robot.
[0062] After sending a second signal to the robot, that is, sending a signal indicating that the robot is not in position, the working mode of the robot is further obtained. Specifically, when the robot is working, the robot may be displaced relative to the base station due to vibration or friction generated during operation of the robot, causing the second charging element to separate from the first charging element.
[0063] The first mode is a working mode that causes the robot to move, but does not require the robot to stay in place.
[0064] Therefore, after the robot receives the second signal sent by the base station, it determines the current working mode. If it is determined that the current working mode is the first mode and no lifting signal is detected, that is, the user does not pick up the robot, it is determined that the second signal may be caused by the vibration or friction generated when the robot works in the first mode, resulting in position deviation. At this time, the robot is controlled to move inward, specifically, in the direction of the first charging element close to the base station, and the specific movement is a preset number of times, so that the robot returns to its original position.
[0065] Exemplarily, the preset number of times is 5 times.
[0066] Exemplarily, the preset number of times is 3 times.
[0067] The embodiment of the present invention controls the robot to move inward several times when it detects that the robot is not in position and is in a working mode that may generate vibration or friction, so that the robot that has deviated from its position returns to a preset position in the base station, thereby ensuring the working reliability of the robot.
[0068] In any of the above technical solutions, the first mode includes: a dust collection mode, a drying mode or a hair cutting mode.
[0069] In this technical solution, the first mode includes a dust collection mode. Specifically, the dust collection mode is a working mode in which the base station uses a fan and other structures to suck the dust collected by the robot from the dust box of the robot into a dust bag provided in the base station.
[0070] The first mode also includes a drying mode. Specifically, the drying mode is a working mode in which the base station dries the cleaning component of the robot by hot air, specifically a rag plate provided on the cleaning component.
[0071] The first mode also includes a hair cutting mode. Specifically, when the robot performs a cleaning operation, the cleaning roller brush of the robot rotates to collect floating dust and garbage on the ground. When there is hair in the garbage, the hair may be entangled in the cleaning roller brush body or the rotating shaft of the cleaning roller brush. The hair cutting mode is to cut off the hair entangled in the roller brush body or the rotating shaft of the roller brush by the cutting blade, so that it is out of the working mode of the roller brush.
[0072] In any of the above technical solutions, the robot also includes running wheels and a cleaning component; after the step of sending a second signal to the robot, the position detection method also includes: when the robot's working mode is the second mode and no lifting signal of the running wheel is detected, controlling the robot to move in the direction close to the first charging element for a preset number of times; when the robot receives the second signal again after moving the preset number of times, controlling the robot to stop working and perform a reminder operation; wherein the second mode is the self-cleaning mode of the cleaning component.
[0073] In this technical solution, the robot is specifically a wheeled robot, and the robot includes running wheels, which are used to drive the robot to move. A sensor is provided on the running wheel to detect whether the running wheel of the robot is lifted. When the running wheel is lifted, the sensor generates a lifting signal, which is used to indicate that the running wheel of the robot is off the ground, that is, the user manually lifts the robot.
[0074] The cleaning component is specifically a mopping component, which includes a driving unit and a rag plate. In some embodiments, the driving unit drives the rag plate to rotate to perform a cleaning operation. In other embodiments, the driving unit drives the rag plate to vibrate at a high frequency to perform a cleaning operation. In yet other embodiments, the driving unit drives the rag plate to reciprocate to perform a cleaning operation.
[0075] After sending a second signal to the robot, that is, sending a signal indicating that the robot is not in position, the working mode of the robot is further obtained. Specifically, when the robot is working, the robot may be displaced relative to the base station due to vibration or friction generated during operation of the robot, causing the second charging element to separate from the first charging element.
[0076] The second mode is a working mode that causes the robot to move and requires the robot to remain in a fixed position. Specifically, the second mode is a self-cleaning mode for cleaning the cleaning component. In the second mode, the robot moves the rag plate on the cleaning component to the cleaning tank of the base station and rotates the rag plate in a set manner to clean the rag plate.
[0077] After the robot receives the second signal sent by the base station, it determines the current working mode. If it is determined that the current working mode is the second mode, that is, the self-cleaning mode, and no lifting signal is detected, that is, the user does not pick up the robot, it is determined that the second signal may be caused by the force of the robot rotating the rag plate, resulting in position deviation. At this time, the robot is controlled to move inward, specifically, in the direction of the first charging element close to the base station, and the specific movement is a preset number of times, so that the robot returns to its original position.
[0078] Exemplarily, the preset number of times is 5 times.
[0079] Exemplarily, the preset number of times is 3 times.
[0080] After controlling the robot to move inward a preset number of times, if the robot receives the second signal again, it means that the robot has not been successfully reset. At this time, at least part of the rag plate may have been outside the cleaning tank. At this time, the robot is controlled to stop working, that is, stop cleaning the rag plate, control the rag plate to stop rotating, and remind the user in a preset manner to manually reset the robot.
[0081] The embodiment of the present invention attempts to control the robot to move inward several times when it is detected that the robot is not in position and the robot is in a self-cleaning working mode, so that the robot that has deviated from its position returns to the preset position in the base station. If the second signal indicating that the robot is not in position is still detected after the common sense reset, the robot is controlled to stop working and a reminder is given, thereby avoiding damage to the robot due to failure and improving the working reliability of the robot.
[0082] In any of the above technical solutions, the reminder operation includes: broadcasting preset reminder information; and / or sending the preset reminder information to the target terminal.
[0083] In this technical solution, when the robot is in the self-cleaning mode for cleaning the rag tray, if a second signal indicating that the robot is not in place is detected and automatic resetting fails, the robot performs a reminder operation.
[0084] Among them, the robot is provided with a speaker, and the reminder operation specifically includes playing a preset reminder message through the speaker, so as to remind the surrounding users that the robot position has deviated, and remind the users to manually help the robot reset.
[0085] The robot can also access the Internet through the Internet of Things or a home gateway, and send a reminder message to the target terminal held by the user, such as the user's mobile phone, to inform the user that the robot has deviated from its position and stopped working, and to remind the user to manually handle the exception.
[0086] A second aspect of the present invention provides a position detection device, which is applied to a robot system. The robot system includes a base station and a robot. The base station includes a first charging element, and the robot includes a second charging element. The position detection device includes:
[0087] An acquisition module is used to acquire a detection signal of the robot at a current position, wherein the detection signal of the current position includes a first signal and a second signal, the first signal is used to indicate that the second charging element is in contact with the first charging element, and the second signal is used to indicate that the second charging element is separated from the first charging element; a timing module is used to start timing when it is detected that the detection signal of the current position changes from the first signal to the second signal; a sending module is used to send a second signal to the robot when the detection signal of the current position obtained is still the second signal after the timing duration reaches a preset duration.
[0088] In this technical solution, the robot system may be a cleaning robot system, such as a mopping robot system or a sweeping and mopping robot system, etc. The robot system includes a base station and a robot, wherein the base station is used to charge the robot, collect dust collected by the robot, and clean the cleaning components of the robot.
[0089] When the robot is performing a cleaning operation or after completing a cleaning operation, the robot will return to the base station to wait and perform operations such as cleaning cleaning components, collecting dust, and cutting hair wrapped around the cleaning brush. The above operations require that the robot is located at a corresponding position in the base station, so the position of the robot needs to be detected.
[0090] Specifically, the base station obtains a detection signal of the current position of the robot. The detection signal of the current position specifically includes two signals, namely a first signal and a second signal. The first signal is a signal that the robot is "in position". When the robot is in position, the second charging element of the robot is in contact with the first charging element of the base station. At this time, the base station can charge the robot, and can also perform operations such as cleaning cleaning components, collecting dust, and cutting hair wrapped around the cleaning brush.
[0091] The second robot is a situation where the robot is “not in place”. When the robot is not in place, it means that the second charging element of the robot is separated from the first charging element of the base station. When the robot is not in place, some operations on the robot may be terminated.
[0092] In the related art, the presence detection is performed based on the electrical signal when the second charging element of the robot contacts the first charging element of the base station. In some cases, such as oxidation of the surface of the second charging element of the robot or the first charging element of the base station, the second charging element of the robot and the first charging element of the base station may be in poor contact, which will cause the circuit between the second charging element and the first charging element to be disconnected instantly. When the robot does not leave the base station, the detection signal of the current position will suddenly change from "in position" to "out of position", so even if the robot does not leave the base station, it will be judged that the robot is not in position, which affects the working efficiency of the robot.
[0093] The first charging element is specifically a spring of the base station, and the second charging element is specifically a contact point of the robot.
[0094] In response to the above situation, when the present application detects that the position signal changes from the first signal indicating that the robot is in place to the second signal indicating that the robot is not in place, the signal that the robot is not in place will not be reported immediately, but a preset delay period will be made. After the preset delay period, if the detection signal of the current position is still the second signal, the second signal indicating that the robot is not in place will be reported to the robot.
[0095] If the detection signal at the current position changes back to the first signal after a preset delay period, the detected second signal is determined to be a false detection, and the falsely detected second signal is not reported, to prevent the robot's operations such as cleaning cleaning components, collecting dust, and cutting hair wrapped around the cleaning brush from being interrupted by false detection due to false detection of signals, thereby ensuring the robot's work efficiency.
[0096] In the embodiment of the present invention, when the robot's in-place signal suddenly changes from in-place to out-of-place, the out-of-place signal is delayed, and the out-of-place signal is sent to the robot only when the detection signal of the current position after the delay is still out-of-place, thereby ensuring the reliability of position detection and improving the working efficiency of the robot.
[0097] The third aspect of the present invention provides a position detection device, comprising: a memory for storing programs or instructions; a processor for implementing the steps of the position detection method provided in any of the above-mentioned technical solutions when executing the programs or instructions, and therefore also including all its technical effects, which will not be repeated here to avoid repetition.
[0098] The fourth aspect of the present invention provides a readable storage medium, on which programs or instructions are stored. When the programs or instructions are executed by a processor, the steps of the position detection method provided in any of the above technical solutions are implemented, and therefore all its technical effects are also included. To avoid repetition, they will not be repeated here.
[0099] The fifth aspect of the present invention provides a computer program product, which is stored in a storage medium. When the computer program product is executed by at least one processor, it implements the steps of the position detection method provided in any of the above technical solutions, and therefore also includes all its technical effects. To avoid repetition, they will not be repeated here.
[0100] The sixth aspect of the present invention provides a robot system, comprising: a position detection device as provided in any of the above technical solutions; and / or a readable storage medium as provided in any of the above technical solutions; and / or a computer program product as provided in any of the above technical solutions, and therefore also includes all of its technical effects, which will not be repeated here to avoid repetition. BRIEF DESCRIPTION OF THE DRAWINGS
[0101] The above and / or additional aspects and advantages of the present invention will become apparent and easily understood from the description of the embodiments in conjunction with the following drawings, in which:
[0102] Figure 1 A schematic diagram of the structure of a robot system according to an embodiment of the present invention is shown;
[0103] Figure 2 A flow chart of a position detection method according to an embodiment of the present invention is shown;
[0104] Figure 3 It shows a structural block diagram of a position detection device according to an embodiment of the present invention;
[0105] Figure 4 A structural block diagram of a position detection device according to an embodiment of the present invention is shown.
[0106] Reference numerals:
[0107] 100 robot system, 102 base station, 1022 first charging element, 104 robot, 1042 second charging element, 1044 running wheel, 1046 cleaning component. DETAILED DESCRIPTION
[0108] In order to more clearly understand the above-mentioned purpose, features and advantages of the present invention, the present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. It should be noted that the embodiments of the present application and the features in the embodiments can be combined with each other without conflict.
[0109] In the following description, many specific details are set forth to facilitate a full understanding of the present invention. However, the present invention may also be implemented in other ways different from those described herein. Therefore, the protection scope of the present invention is not limited to the specific embodiments disclosed below.
[0110] Refer to the following Figures 1 to 4 The position detection method, device, storage medium, program product and robot system according to some embodiments of the present invention are described.
[0111] In some embodiments of the present invention, a position detection method is provided, which is applied to a robot system. Figure 1 FIG. 4 shows a schematic diagram of the structure of a robot system according to an embodiment of the present invention. Figure 1 As shown, the robot system 100 includes a base station 102 and a robot 104 , the base station 102 includes a first charging element 1022 , and the robot 104 includes a second charging element 1042 ;
[0112] Figure 2 FIG. 4 shows a flow chart of a position detection method according to an embodiment of the present invention. Figure 2 As shown, the position detection method includes:
[0113] Step 202, obtaining a detection signal of the current position;
[0114] The detection signal of the current position includes a first signal and a second signal, the first signal is used to indicate that the second charging element is in contact with the first charging element, and the second signal is used to indicate that the second charging element is separated from the first charging element;
[0115] Step 204, when it is detected that the detection signal of the current position changes from the first signal to the second signal, start timing;
[0116] Step 206: After the timing duration reaches the preset duration, if the detection signal of the current position obtained is still the second signal, send the second signal to the robot.
[0117] In the embodiment of the present invention, the robot system may be a cleaning robot system, such as a mopping robot system or a sweeping and mopping robot system, etc. The robot system includes a base station and a robot, wherein the base station is used to charge the robot, collect dust collected by the robot, and clean the cleaning components of the robot.
[0118] When the robot is performing a cleaning operation or after completing a cleaning operation, the robot will return to the base station to wait and perform operations such as cleaning cleaning components, collecting dust, and cutting hair wrapped around the cleaning brush. The above operations require that the robot is located at a corresponding position in the base station, so the position of the robot needs to be detected.
[0119] Specifically, the base station obtains a detection signal of the current position of the robot. The detection signal of the current position specifically includes two signals, namely a first signal and a second signal. The first signal is a signal that the robot is "in position". When the robot is in position, the second charging element of the robot is in contact with the first charging element of the base station. At this time, the base station can charge the robot, and can also perform operations such as cleaning cleaning components, collecting dust, and cutting hair wrapped around the cleaning brush.
[0120] The second robot is a situation where the robot is “not in place”. When the robot is not in place, it means that the second charging element of the robot is separated from the first charging element of the base station. When the robot is not in place, some operations on the robot may be terminated.
[0121] In the related art, the presence detection is performed based on the electrical signal when the second charging element of the robot contacts the first charging element of the base station. In some cases, such as oxidation of the surface of the second charging element of the robot or the first charging element of the base station, the second charging element of the robot and the first charging element of the base station may be in poor contact, which will cause the circuit between the second charging element and the first charging element to be disconnected instantly. When the robot does not leave the base station, the detection signal of the current position will suddenly change from "in position" to "out of position", so even if the robot does not leave the base station, it will be judged that the robot is not in position, which affects the working efficiency of the robot.
[0122] The first charging element is specifically a spring of the base station, and the second charging element is specifically a contact point of the robot.
[0123] In response to the above situation, when the present application detects that the position signal changes from the first signal indicating that the robot is in place to the second signal indicating that the robot is not in place, the signal that the robot is not in place will not be reported immediately, but a preset delay period will be made. After the preset delay period, if the detection signal of the current position is still the second signal, the second signal indicating that the robot is not in place will be reported to the robot.
[0124] If the detection signal at the current position changes back to the first signal after a preset delay period, the detected second signal is determined to be a false detection, and the falsely detected second signal is not reported, to prevent the robot's operations such as cleaning cleaning components, collecting dust, and cutting hair wrapped around the cleaning brush from being interrupted by false detection due to false detection of signals, thereby ensuring the robot's work efficiency.
[0125] In the embodiment of the present invention, when the robot's in-place signal suddenly changes from in-place to out-of-place, the out-of-place signal is delayed, and the out-of-place signal is sent to the robot only when the detection signal of the current position after the delay is still out-of-place, thereby ensuring the reliability of position detection and improving the working efficiency of the robot.
[0126] Based on any of the above embodiments, the step of obtaining the detection signal of the current position includes: obtaining the load signal of the base station; determining the comparison result between the signal value of the load signal and the threshold; and determining whether the detection signal of the current position is the first signal or the second signal based on the comparison result.
[0127] In an embodiment of the present invention, the load signal of the base station is detected, and the signal value of the detected load signal is compared with a preset threshold value. According to the comparison result, it is determined whether the robot is in place or not, specifically, whether the detection signal is the first signal or the second signal.
[0128] Specifically, the base station can charge the robot. When the robot is not in place, the load of the base station is fixed, so the signal value of the load signal is also in a relatively stable range. When the robot is in place, the second charging element of the robot is in contact with the first charging element of the base station. At this time, a loop is formed between the second charging element and the first charging element, and the load of the base station will change. Therefore, according to the load signal of the base station, it can be accurately determined whether the second charging element of the robot is in contact with the first charging element of the base station, and it can also be accurately determined whether the robot is in place.
[0129] The embodiment of the present invention can accurately identify whether the robot is in place by comparing the signal value of the load signal of the base station with the threshold value, thereby improving the accuracy of the robot's in-place detection.
[0130] Based on any of the above embodiments, the signal value includes a load current value and a load voltage value, and the threshold includes a current threshold and a voltage threshold;
[0131] The step of determining whether the detection signal of the current position is the first signal or the second signal according to the comparison result includes: when the load current value is less than or equal to the current threshold, and the load voltage value is less than or equal to the voltage threshold, determining that the detection signal of the current position is the first signal; when the load current value is greater than the current threshold, and the load voltage value is greater than the voltage threshold, determining that the detection signal of the current position is the second signal.
[0132] In the embodiment of the present invention, the signal value of the load signal of the base station specifically includes a load current value and a load voltage value, and correspondingly, the threshold specifically includes a current threshold and a voltage threshold.
[0133] Specifically, when it is detected that the load current value is greater than the current threshold and the load voltage value is greater than the voltage threshold, it is determined that the second charging element of the robot is not connected to the first charging element, and the robot is not in place at this time.
[0134] When it is detected that the load current value is less than or equal to the current threshold, and at the same time the load voltage value is less than or equal to the voltage threshold, it is determined that the second charging element of the robot is connected to the first charging element, and the robot is in place.
[0135] The embodiment of the present invention can accurately identify whether the robot is in place by comparing the load current value of the base station with the current threshold, and the load voltage value of the base station with the voltage threshold, thereby improving the accuracy of the robot's in-place detection.
[0136] Based on any of the above embodiments, the load signal includes N consecutive signal values, where N is a positive integer; and the step of determining a comparison result between the signal value of the load signal and the threshold value includes:
[0137] Determine N comparison results of N signal values and threshold values respectively; determine the detection signal of the current position as the first signal or the second signal according to the comparison results, comprising: when the number of comparison results satisfying the preset condition corresponding to the first signal among the N comparison results is greater than or equal to the number of comparison results satisfying the preset condition corresponding to the second signal, determine the detection signal of the current position as the first signal;
[0138] When, among the N comparison results, the number of comparison results satisfying the preset condition corresponding to the first signal is less than the number of comparison results satisfying the preset condition corresponding to the second signal, it is determined that the detection signal of the current position is the second signal.
[0139] In an embodiment of the present invention, filtering processing of the detection signal of the current position is added. Specifically, when collecting the load signal of the base station, N signal values of the load signal are continuously collected according to a preset collection period, and the comparison result of each signal value in the N signal values and the signal threshold is determined respectively, and among the N comparison results obtained by comparison, the number of comparison results that meet the preset condition of the first signal and the number of comparison results that meet the preset condition of the second signal are determined.
[0140] Exemplarily, the N signal values may be signal values collected within a certain period of time, such as signal values collected within 1.5 seconds.
[0141] If the number of comparison results satisfying the preset condition corresponding to the first signal is greater than or equal to the number of comparison results satisfying the preset condition of the second signal, it is determined that the detection signal at the current position is specifically the first signal and the robot is in place.
[0142] Similarly, if the number of comparison results that satisfy the preset condition corresponding to the second signal is greater than the number of comparison results that satisfy the preset condition of the first signal, it is determined that the detection signal at the current position is specifically the second signal and the robot is not in place.
[0143] Specifically, the N signal values include N current values and N voltage values corresponding to the N current values one by one. Each current value and the corresponding voltage value form a set of data, so there are N sets of data in total.
[0144] When a group of data satisfies that the current value is less than or equal to the current threshold, and the voltage value is less than or equal to the voltage threshold, it is determined that the group of data, that is, the signal value, satisfies the preset condition corresponding to the first signal.
[0145] When a group of data satisfies that the current value is greater than the current threshold value and the voltage value is greater than the voltage threshold value, it is determined that the group of data, that is, the signal value, satisfies the preset condition corresponding to the second signal.
[0146] Assume that N=40, that is, among the 40 signal values obtained, there are greater than or equal to 20 signal values that meet the preset conditions corresponding to the first signal, then the detection signal at the current position is determined to be the first signal. If there are greater than or equal to 21 signal values that meet the preset conditions corresponding to the second signal, then the current detection signal is determined to be the second signal.
[0147] The embodiment of the present application filters the load signal of the base station for a certain period of time, and determines whether the robot is in place based on the side with a larger proportion of judgment results among the N collected signal values. This can effectively reduce false detections caused by poor contact between the first charging element and the second charging element, and improve the reliability and accuracy of the robot's in-place detection.
[0148] Based on any of the above embodiments, the value range of the current threshold is: greater than or equal to 20ma and less than or equal to 40ma; the value range of the voltage threshold is: greater than or equal to 2.1V and less than or equal to 4V.
[0149] In the embodiment of the present invention, assuming that the current threshold is A, 20ma≤A≤40ma is satisfied.
[0150] Exemplarily, the current threshold is 28 mA.
[0151] Exemplarily, the current threshold is 30 mA.
[0152] Assuming the voltage threshold is U, then 2.1V≤U≤4V is satisfied.
[0153] Exemplarily, the voltage threshold is 3.1V.
[0154] Exemplarily, the voltage threshold is 2.8V.
[0155] When the collected load current is less than or equal to the current threshold, and the collected load voltage is less than or equal to the voltage threshold, it is determined that the collected detection signal of the current position of the robot is specifically the first signal. When the collected load current is greater than the current threshold, and the collected load voltage is greater than the voltage threshold, it is determined that the collected detection signal of the current position of the robot is specifically the first signal.
[0156] The embodiment of the present invention can accurately identify whether the spring clip of the base station outputs a power signal, that is, whether the contact of the robot is in contact with the spring clip of the base station, by comparing the load current and load voltage of the base station with the corresponding current threshold and voltage threshold, thereby judging whether the robot is in place and improving the accuracy of the robot's in-place detection.
[0157] Based on any of the above embodiments, the value range of N is: 25≤N≤55.
[0158] In the embodiment of the present invention, when collecting the load signal of the base station, N signal values of the load signal are continuously collected according to a preset collection period, where N is an integer greater than or equal to 25 and less than or equal to 55.
[0159] Exemplarily, N=45.
[0160] Exemplarily, N=40.
[0161] Taking N=40 as an example, within 1.5 seconds, a signal value is collected every 37.5ms, and a total of 40 signal values are collected within 1.5 seconds. If there are greater than or equal to 20 signal values among the 40 signal values that meet the preset conditions corresponding to the first signal, then the detection signal at the current position is determined to be the first signal. If there are greater than or equal to 21 signal values that meet the preset conditions corresponding to the second signal, then the current detection signal is determined to be the second signal.
[0162] The embodiment of the present invention collects N continuous signal values, determines the final position detection result based on the comparison result of the number of first signals and the number of second signals among the N signal values, and by appropriately setting the number of signal values, can improve the detection accuracy and reliability while ensuring the timeliness of the position detection result.
[0163] Based on any of the above embodiments, Figure 1As shown, the robot 104 also includes a running wheel 1044; after the step of sending a second signal to the robot, the position detection method also includes: when the robot's working mode is the first mode and no lifting signal of the running wheel is detected, controlling the robot to move a preset number of times in a direction close to the first charging element.
[0164] In an embodiment of the present invention, the robot is specifically a wheeled robot, and the robot includes running wheels, which are used to drive the robot to move. A sensor is provided on the running wheel, which is used to detect whether the running wheel of the robot is lifted. When the running wheel is lifted, the sensor generates a lifting signal, which is used to indicate that the running wheel of the robot is off the ground, that is, the user manually lifts the robot.
[0165] After sending a second signal to the robot, that is, sending a signal indicating that the robot is not in position, the working mode of the robot is further obtained. Specifically, when the robot is working, the robot may be displaced relative to the base station due to vibration or friction generated during operation of the robot, causing the second charging element to separate from the first charging element.
[0166] The first mode is a working mode that causes the robot to move, but does not require the robot to stay in place.
[0167] Therefore, after the robot receives the second signal sent by the base station, it determines the current working mode. If it is determined that the current working mode is the first mode and no lifting signal is detected, that is, the user does not pick up the robot, it is determined that the second signal may be caused by the vibration or friction generated when the robot works in the first mode, resulting in position deviation. At this time, the robot is controlled to move inward, specifically, in the direction of the first charging element close to the base station, and the specific movement is a preset number of times, so that the robot returns to its original position.
[0168] Exemplarily, the preset number of times is 5 times.
[0169] Exemplarily, the preset number of times is 3 times.
[0170] The embodiment of the present invention controls the robot to move inward several times when it detects that the robot is not in position and is in a working mode that may generate vibration or friction, so that the robot that has deviated from its position returns to a preset position in the base station, thereby ensuring the working reliability of the robot.
[0171] Based on any of the above embodiments, the first mode includes: a dust collection mode, a drying mode or a hair cutting mode.
[0172] In an embodiment of the present invention, the first mode includes a dust collection mode. Specifically, the dust collection mode is a working mode in which the base station uses a fan and other structures to suck the dust collected by the robot from the dust box of the robot into a dust bag provided in the base station.
[0173] The first mode also includes a drying mode. Specifically, the drying mode is a working mode in which the base station dries the cleaning component of the robot by hot air, specifically a rag plate provided on the cleaning component.
[0174] The first mode also includes a hair cutting mode. Specifically, when the robot performs a cleaning operation, the cleaning roller brush of the robot rotates to collect floating dust and garbage on the ground. When there is hair in the garbage, the hair may be entangled in the cleaning roller brush body or the rotating shaft of the cleaning roller brush. The hair cutting mode is to cut off the hair entangled in the roller brush body or the rotating shaft of the roller brush by the cutting blade, so that it is out of the working mode of the roller brush.
[0175] Based on any of the above embodiments, Figure 1 As shown, the robot 104 also includes a running wheel 1044 and a cleaning component 1046; after the step of sending a second signal to the robot, the position detection method also includes: when the robot's working mode is the second mode and no lifting signal of the running wheel is detected, controlling the robot to move in a direction close to the first charging element for a preset number of times; when the robot receives the second signal again after moving the preset number of times, controlling the robot to stop working and perform a reminder operation; wherein the second mode is a self-cleaning mode of the cleaning component.
[0176] In an embodiment of the present invention, the robot is specifically a wheeled robot, and the robot includes running wheels, which are used to drive the robot to move. A sensor is provided on the running wheel, which is used to detect whether the running wheel of the robot is lifted. When the running wheel is lifted, the sensor generates a lifting signal, which is used to indicate that the running wheel of the robot is off the ground, that is, the user manually lifts the robot.
[0177] The cleaning component is specifically a mopping component, which includes a driving unit and a rag plate. In some embodiments, the driving unit drives the rag plate to rotate to perform a cleaning operation. In other embodiments, the driving unit drives the rag plate to vibrate at a high frequency to perform a cleaning operation. In yet other embodiments, the driving unit drives the rag plate to reciprocate to perform a cleaning operation.
[0178] After sending a second signal to the robot, that is, sending a signal indicating that the robot is not in position, the working mode of the robot is further obtained. Specifically, when the robot is working, the robot may be displaced relative to the base station due to vibration or friction generated during operation of the robot, causing the second charging element to separate from the first charging element.
[0179] The second mode is a working mode that causes the robot to move and requires the robot to remain in a fixed position. Specifically, the second mode is a self-cleaning mode for cleaning the cleaning component. In the second mode, the robot moves the rag plate on the cleaning component to the cleaning tank of the base station and rotates the rag plate in a set manner to clean the rag plate.
[0180] After the robot receives the second signal sent by the base station, it determines the current working mode. If it is determined that the current working mode is the second mode, that is, the self-cleaning mode, and no lifting signal is detected, that is, the user does not pick up the robot, it is determined that the second signal may be caused by the force of the robot rotating the rag plate, resulting in position deviation. At this time, the robot is controlled to move inward, specifically, in the direction of the first charging element close to the base station, and the specific movement is a preset number of times, so that the robot returns to its original position.
[0181] Exemplarily, the preset number of times is 5 times.
[0182] Exemplarily, the preset number of times is 3 times.
[0183] After controlling the robot to move inward a preset number of times, if the robot receives the second signal again, it means that the robot has not been successfully reset. At this time, at least part of the rag plate may have been outside the cleaning tank. At this time, the robot is controlled to stop working, that is, stop cleaning the rag plate, control the rag plate to stop rotating, and remind the user in a preset manner to manually reset the robot.
[0184] The embodiment of the present invention attempts to control the robot to move inward several times when it is detected that the robot is not in position and the robot is in a self-cleaning working mode, so that the robot that has deviated from its position returns to the preset position in the base station. If the second signal indicating that the robot is not in position is still detected after the common sense reset, the robot is controlled to stop working and a reminder is given, thereby avoiding damage to the robot due to failure and improving the working reliability of the robot.
[0185] Based on any of the above embodiments, the reminder operation includes: broadcasting preset reminder information; and / or sending the preset reminder information to the target terminal.
[0186] In an embodiment of the present invention, when the robot is in a self-cleaning mode for cleaning a dishcloth, if a second signal indicating that the robot is not in position is detected and automatic resetting fails, the robot performs a reminder operation.
[0187] Among them, the robot is provided with a speaker, and the reminder operation specifically includes playing a preset reminder message through the speaker, so as to remind the surrounding users that the robot position has deviated, and remind the users to manually help the robot reset.
[0188] The robot can also access the Internet through the Internet of Things or a home gateway, and send a reminder message to the target terminal held by the user, such as the user's mobile phone, to inform the user that the robot has deviated from its position and stopped working, and to remind the user to manually handle the exception.
[0189] In some embodiments of the present invention, a position detection device is provided, which is applied to a robot system. The robot system includes a base station and a robot. The base station includes a first charging element, and the robot includes a second charging element. Figure 3 FIG. 4 shows a structural block diagram of a position detection device according to an embodiment of the present invention. Figure 3 As shown, the position detection device 300 includes:
[0190] An acquisition module 302 is used to acquire a detection signal of a current position, wherein the detection signal of the current position includes a first signal and a second signal, the first signal is used to indicate that the second charging element is in contact with the first charging element, and the second signal is used to indicate that the second charging element is separated from the first charging element;
[0191] A timing module 304, configured to start timing when detecting that the detection signal of the current position changes from the first signal to the second signal;
[0192] The sending module 306 is used to send a second signal to the robot when the detection signal of the current position obtained is still the second signal after the timing duration reaches a preset duration.
[0193] In the embodiment of the present invention, the robot system may be a cleaning robot system, such as a mopping robot system or a sweeping and mopping robot system, etc. The robot system includes a base station and a robot, wherein the base station is used to charge the robot, collect dust collected by the robot, and clean the cleaning components of the robot.
[0194] When the robot is performing a cleaning operation or after completing a cleaning operation, the robot will return to the base station to wait and perform operations such as cleaning cleaning components, collecting dust, and cutting hair wrapped around the cleaning brush. The above operations require that the robot is located at a corresponding position in the base station, so the position of the robot needs to be detected.
[0195] Specifically, the base station obtains a detection signal of the current position of the robot. The detection signal of the current position specifically includes two signals, namely a first signal and a second signal. The first signal is a signal that the robot is "in position". When the robot is in position, the second charging element of the robot is in contact with the first charging element of the base station. At this time, the base station can charge the robot, and can also perform operations such as cleaning cleaning components, collecting dust, and cutting hair wrapped around the cleaning brush.
[0196] The second robot is a situation where the robot is “not in place”. When the robot is not in place, it means that the second charging element of the robot is separated from the first charging element of the base station. When the robot is not in place, some operations on the robot may be terminated.
[0197] In the related art, the presence detection is performed based on the electrical signal when the second charging element of the robot contacts the first charging element of the base station. In some cases, such as oxidation of the surface of the second charging element of the robot or the first charging element of the base station, the second charging element of the robot and the first charging element of the base station may be in poor contact, which will cause the circuit between the second charging element and the first charging element to be disconnected instantly. When the robot does not leave the base station, the detection signal of the current position will suddenly change from "in position" to "out of position", so even if the robot does not leave the base station, it will be judged that the robot is not in position, which affects the working efficiency of the robot.
[0198] The first charging element is specifically a spring of the base station, and the second charging element is specifically a contact point of the robot.
[0199] In response to the above situation, when the present application detects that the position signal changes from the first signal indicating that the robot is in place to the second signal indicating that the robot is not in place, the signal that the robot is not in place will not be reported immediately, but a preset delay period will be made. After the preset delay period, if the detection signal of the current position is still the second signal, the second signal indicating that the robot is not in place will be reported to the robot.
[0200] If the detection signal at the current position changes back to the first signal after a preset delay period, the detected second signal is determined to be a false detection, and the falsely detected second signal is not reported, to prevent the robot's operations such as cleaning cleaning components, collecting dust, and cutting hair wrapped around the cleaning brush from being interrupted by false detection due to false detection of signals, thereby ensuring the robot's work efficiency.
[0201] In the embodiment of the present invention, when the robot's in-place signal suddenly changes from in-place to out-of-place, the out-of-place signal is delayed, and the out-of-place signal is sent to the robot only when the detection signal of the current position after the delay is still out-of-place, thereby ensuring the reliability of position detection and improving the working efficiency of the robot.
[0202] Based on any of the above embodiments, the acquisition module is further used to acquire a load signal of the base station; determine a comparison result between a signal value of the load signal and a threshold;
[0203] The position detection device also includes a determination module, which is used to determine whether the detection signal of the current position is the first signal or the second signal according to the comparison result.
[0204] In an embodiment of the present invention, the load signal of the base station is detected, and the signal value of the detected load signal is compared with a preset threshold value. According to the comparison result, it is determined whether the robot is in place or not, specifically, whether the detection signal is the first signal or the second signal.
[0205] Specifically, the base station can charge the robot. When the robot is not in place, the load of the base station is fixed, so the signal value of the load signal is also in a relatively stable range. When the robot is in place, the second charging element of the robot is in contact with the first charging element of the base station. At this time, a loop is formed between the second charging element and the first charging element, and the load of the base station will change. Therefore, according to the load signal of the base station, it can be accurately determined whether the second charging element of the robot is in contact with the first charging element of the base station, and it can also be accurately determined whether the robot is in place.
[0206] The embodiment of the present invention can accurately identify whether the robot is in place by comparing the signal value of the load signal of the base station with the threshold value, thereby improving the accuracy of the robot's in-place detection.
[0207] Based on any of the above embodiments, the signal value includes a load current value and a load voltage value, and the threshold includes a current threshold and a voltage threshold;
[0208] The determination module is specifically used to: when the load current value is less than or equal to the current threshold, and the load voltage value is less than or equal to the voltage threshold, determine that the detection signal of the current position is the first signal; when the load current value is greater than the current threshold, and the load voltage value is greater than the voltage threshold, determine that the detection signal of the current position is the second signal.
[0209] In the embodiment of the present invention, the signal value of the load signal of the base station specifically includes a load current value and a load voltage value, and correspondingly, the threshold specifically includes a current threshold and a voltage threshold.
[0210] Specifically, when it is detected that the load current value is greater than the current threshold and the load voltage value is greater than the voltage threshold, it is determined that the second charging element of the robot is not connected to the first charging element, and the robot is not in place at this time.
[0211] When it is detected that the load current value is less than or equal to the current threshold, and at the same time the load voltage value is less than or equal to the voltage threshold, it is determined that the second charging element of the robot is connected to the first charging element, and the robot is in place.
[0212] The embodiment of the present invention can accurately identify whether the robot is in place by comparing the load current value of the base station with the current threshold, and the load voltage value of the base station with the voltage threshold, thereby improving the accuracy of the robot's in-place detection.
[0213] On the basis of any of the above embodiments, the load signal includes N consecutive signal values, where N is a positive integer; the determination module is specifically configured to:
[0214] Determine N comparison results of N signal values and threshold values respectively; determine the detection signal of the current position as the first signal or the second signal according to the comparison results, comprising: when the number of comparison results satisfying the preset condition corresponding to the first signal among the N comparison results is greater than or equal to the number of comparison results satisfying the preset condition corresponding to the second signal, determine the detection signal of the current position as the first signal;
[0215] When, among the N comparison results, the number of comparison results satisfying the preset condition corresponding to the first signal is less than the number of comparison results satisfying the preset condition corresponding to the second signal, it is determined that the detection signal of the current position is the second signal.
[0216] In an embodiment of the present invention, filtering processing of the detection signal of the current position is added. Specifically, when collecting the load signal of the base station, N signal values of the load signal are continuously collected according to a preset collection period, and the comparison result of each signal value in the N signal values and the signal threshold is determined respectively, and among the N comparison results obtained by comparison, the number of comparison results that meet the preset condition of the first signal and the number of comparison results that meet the preset condition of the second signal are determined.
[0217] Exemplarily, the N signal values may be signal values collected within a certain period of time, such as signal values collected within 1.5 seconds.
[0218] If the number of comparison results satisfying the preset condition corresponding to the first signal is greater than or equal to the number of comparison results satisfying the preset condition of the second signal, it is determined that the detection signal at the current position is specifically the first signal and the robot is in place.
[0219] Similarly, if the number of comparison results that satisfy the preset condition corresponding to the second signal is greater than the number of comparison results that satisfy the preset condition of the first signal, it is determined that the detection signal at the current position is specifically the second signal and the robot is not in place.
[0220] Specifically, the N signal values include N current values and N voltage values corresponding to the N current values one by one. Each current value and the corresponding voltage value form a set of data, so there are N sets of data in total.
[0221] When a group of data satisfies that the current value is less than or equal to the current threshold, and the voltage value is less than or equal to the voltage threshold, it is determined that the group of data, that is, the signal value, satisfies the preset condition corresponding to the first signal.
[0222] When a group of data satisfies that the current value is greater than the current threshold value and the voltage value is greater than the voltage threshold value, it is determined that the group of data, that is, the signal value, satisfies the preset condition corresponding to the second signal.
[0223] Assume that N=40, that is, among the 40 signal values obtained, there are greater than or equal to 20 signal values that meet the preset conditions corresponding to the first signal, then the detection signal at the current position is determined to be the first signal. If there are greater than or equal to 21 signal values that meet the preset conditions corresponding to the second signal, then the current detection signal is determined to be the second signal.
[0224] The embodiment of the present application filters the load signal of the base station for a certain period of time, and determines whether the robot is in place based on the side with a larger proportion of judgment results among the N collected signal values. This can effectively reduce false detections caused by poor contact between the first charging element and the second charging element, and improve the reliability and accuracy of the robot's in-place detection.
[0225] Based on any of the above embodiments, the value range of the current threshold is: greater than or equal to 20ma and less than or equal to 40ma; the value range of the voltage threshold is: greater than or equal to 2.1V and less than or equal to 4V.
[0226] In the embodiment of the present invention, assuming that the current threshold is A, 20ma≤A≤40ma is satisfied.
[0227] Exemplarily, the current threshold is 28 mA.
[0228] Exemplarily, the current threshold is 30 mA.
[0229] Assuming the voltage threshold is U, then 2.1V≤U≤4V is satisfied.
[0230] Exemplarily, the voltage threshold is 3.1V.
[0231] Exemplarily, the voltage threshold is 2.8V.
[0232] When the collected load current is less than or equal to the current threshold, and the collected load voltage is less than or equal to the voltage threshold, it is determined that the collected detection signal of the current position of the robot is specifically the first signal. When the collected load current is greater than the current threshold, and the collected load voltage is greater than the voltage threshold, it is determined that the collected detection signal of the current position of the robot is specifically the first signal.
[0233] The embodiment of the present invention can accurately identify whether the spring clip of the base station outputs a power signal, that is, whether the contact of the robot is in contact with the spring clip of the base station, by comparing the load current and load voltage of the base station with the corresponding current threshold and voltage threshold, thereby judging whether the robot is in place and improving the accuracy of the robot's in-place detection.
[0234] Based on any of the above embodiments, the value range of N is: 25≤N≤55.
[0235] In the embodiment of the present invention, when collecting the load signal of the base station, N signal values of the load signal are continuously collected according to a preset collection period, where N is an integer greater than or equal to 25 and less than or equal to 55.
[0236] Exemplarily, N=45.
[0237] Exemplarily, N=40.
[0238] Taking N=40 as an example, within 1.5 seconds, a signal value is collected every 37.5ms, and a total of 40 signal values are collected within 1.5 seconds. If there are greater than or equal to 20 signal values among the 40 signal values that meet the preset conditions corresponding to the first signal, then the detection signal at the current position is determined to be the first signal. If there are greater than or equal to 21 signal values that meet the preset conditions corresponding to the second signal, then the current detection signal is determined to be the second signal.
[0239] The embodiment of the present invention collects N continuous signal values, determines the final position detection result based on the comparison result of the number of first signals and the number of second signals among the N signal values, and by appropriately setting the number of signal values, can improve the detection accuracy and reliability while ensuring the timeliness of the position detection result.
[0240] Based on any of the above embodiments, Figure 1 As shown, the robot 104 also includes a running wheel 1044; the position detection device also includes a control module, which is used to: when the robot's working mode is the first mode and no lifting signal of the running wheel is detected, control the robot to move a preset number of times in the direction close to the first charging element.
[0241] In an embodiment of the present invention, the robot is specifically a wheeled robot, and the robot includes running wheels, which are used to drive the robot to move. A sensor is provided on the running wheel, which is used to detect whether the running wheel of the robot is lifted. When the running wheel is lifted, the sensor generates a lifting signal, which is used to indicate that the running wheel of the robot is off the ground, that is, the user manually lifts the robot.
[0242] After sending a second signal to the robot, that is, sending a signal indicating that the robot is not in position, the working mode of the robot is further obtained. Specifically, when the robot is working, the robot may be displaced relative to the base station due to vibration or friction generated during operation of the robot, causing the second charging element to separate from the first charging element.
[0243] The first mode is a working mode that causes the robot to move, but does not require the robot to stay in place.
[0244] Therefore, after the robot receives the second signal sent by the base station, it determines the current working mode. If it is determined that the current working mode is the first mode and no lifting signal is detected, that is, the user does not pick up the robot, it is determined that the second signal may be caused by the vibration or friction generated when the robot works in the first mode, resulting in position deviation. At this time, the robot is controlled to move inward, specifically, in the direction of the first charging element close to the base station, and the specific movement is a preset number of times, so that the robot returns to its original position.
[0245] Exemplarily, the preset number of times is 5 times.
[0246] Exemplarily, the preset number of times is 3 times.
[0247] The embodiment of the present invention controls the robot to move inward several times when it detects that the robot is not in position and is in a working mode that may generate vibration or friction, so that the robot that has deviated from its position returns to a preset position in the base station, thereby ensuring the working reliability of the robot.
[0248] Based on any of the above embodiments, the first mode includes: a dust collection mode, a drying mode or a hair cutting mode.
[0249] In an embodiment of the present invention, the first mode includes a dust collection mode. Specifically, the dust collection mode is a working mode in which the base station uses a fan and other structures to suck the dust collected by the robot from the dust box of the robot into a dust bag provided in the base station.
[0250] The first mode also includes a drying mode. Specifically, the drying mode is a working mode in which the base station dries the cleaning component of the robot by hot air, specifically, a rag plate provided on the cleaning component.
[0251] The first mode also includes a hair cutting mode. Specifically, when the robot performs a cleaning operation, the cleaning roller brush of the robot rotates to collect floating dust and garbage on the ground. When there is hair in the garbage, the hair may be entangled in the cleaning roller brush body or the rotating shaft of the cleaning roller brush. The hair cutting mode is to cut off the hair entangled in the roller brush body or the rotating shaft of the roller brush by the cutting blade, so that it is out of the working mode of the roller brush.
[0252] Based on any of the above embodiments, Figure 1As shown, the robot 104 also includes running wheels 1044 and a cleaning component 1046; the control module is also used to: when the robot's working mode is the second mode and no lifting signal of the running wheel is detected, control the robot to move in the direction close to the first charging element for a preset number of times; when the robot receives the second signal again after moving the preset number of times, control the robot to stop working and perform a reminder operation; wherein the second mode is the self-cleaning mode of the cleaning component.
[0253] In an embodiment of the present invention, the robot is specifically a wheeled robot, and the robot includes running wheels, which are used to drive the robot to move. A sensor is provided on the running wheel, which is used to detect whether the running wheel of the robot is lifted. When the running wheel is lifted, the sensor generates a lifting signal, which is used to indicate that the running wheel of the robot is off the ground, that is, the user manually lifts the robot.
[0254] The cleaning component is specifically a mopping component, which includes a driving unit and a rag plate. In some embodiments, the driving unit drives the rag plate to rotate to perform a cleaning operation. In other embodiments, the driving unit drives the rag plate to vibrate at a high frequency to perform a cleaning operation. In yet other embodiments, the driving unit drives the rag plate to reciprocate to perform a cleaning operation.
[0255] After sending a second signal to the robot, that is, sending a signal indicating that the robot is not in position, the working mode of the robot is further obtained. Specifically, when the robot is working, the robot may be displaced relative to the base station due to vibration or friction generated during operation of the robot, causing the second charging element to separate from the first charging element.
[0256] The second mode is a working mode that causes the robot to move and requires the robot to remain in a fixed position. Specifically, the second mode is a self-cleaning mode for cleaning the cleaning component. In the second mode, the robot moves the rag plate on the cleaning component to the cleaning tank of the base station and rotates the rag plate in a set manner to clean the rag plate.
[0257] After the robot receives the second signal sent by the base station, it determines the current working mode. If it is determined that the current working mode is the second mode, that is, the self-cleaning mode, and no lifting signal is detected, that is, the user does not pick up the robot, it is determined that the second signal may be caused by the force of the robot rotating the rag plate, resulting in position deviation. At this time, the robot is controlled to move inward, specifically, in the direction of the first charging element close to the base station, and the specific movement is a preset number of times, so that the robot returns to its original position.
[0258] Exemplarily, the preset number of times is 5 times.
[0259] Exemplarily, the preset number of times is 3 times.
[0260] After controlling the robot to move inward a preset number of times, if the robot receives the second signal again, it means that the robot has not been successfully reset. At this time, at least part of the rag plate may have been outside the cleaning tank. At this time, the robot is controlled to stop working, that is, stop cleaning the rag plate, control the rag plate to stop rotating, and remind the user in a preset manner to manually reset the robot.
[0261] The embodiment of the present invention attempts to control the robot to move inward several times when it is detected that the robot is not in position and the robot is in a self-cleaning working mode, so that the robot that has deviated from its position returns to the preset position in the base station. If the second signal indicating that the robot is not in position is still detected after the common sense reset, the robot is controlled to stop working and a reminder is given, thereby avoiding damage to the robot due to failure and improving the working reliability of the robot.
[0262] Based on any of the above embodiments, the reminder operation includes: broadcasting preset reminder information; and / or sending the preset reminder information to the target terminal.
[0263] In an embodiment of the present invention, when the robot is in a self-cleaning mode for cleaning a dishcloth, if a second signal indicating that the robot is not in position is detected and automatic resetting fails, the robot performs a reminder operation.
[0264] Among them, the robot is provided with a speaker, and the reminder operation specifically includes playing a preset reminder message through the speaker, so as to remind the surrounding users that the robot position has deviated, and remind the users to manually help the robot reset.
[0265] The robot can also access the Internet through the Internet of Things or a home gateway, and send a reminder message to the target terminal held by the user, such as the user's mobile phone, to inform the user that the robot has deviated from its position and stopped working, and to remind the user to manually handle the exception.
[0266] In some embodiments of the present invention, a position detection device is provided. Figure 4 FIG. 4 shows a structural block diagram of a position detection device according to an embodiment of the present invention. Figure 4 As shown, the position detection device 400 includes: a memory 402 for storing programs or instructions; a processor 404, for implementing the steps of the position detection method provided in any of the above embodiments when executing the programs or instructions, and therefore also includes all its technical effects, which will not be repeated here to avoid repetition.
[0267] In some embodiments of the present invention, a readable storage medium is provided, on which a program or instruction is stored. When the program or instruction is executed by a processor, the steps of the position detection method provided in any of the above embodiments are implemented, and therefore all the technical effects thereof are also included. To avoid repetition, they will not be described here.
[0268] In some embodiments of the present invention, a computer program product is provided. The computer program product is stored in a storage medium. When the computer program product is executed by at least one processor, it implements the steps of the position detection method provided in any of the above embodiments, and therefore also includes all its technical effects. To avoid repetition, they will not be repeated here.
[0269] In some embodiments of the present invention, a robot system is provided, including: a position detection device as provided in any of the above embodiments; and / or a readable storage medium as provided in any of the above embodiments; and / or a computer program product as provided in any of the above embodiments, and therefore also including all the technical effects thereof, which will not be described again here to avoid repetition.
[0270] In the description of the present invention, the term "plurality" refers to two or more than two. Unless otherwise clearly defined, the orientation or positional relationship indicated by the terms "upper" and "lower" is based on the orientation or positional relationship described in the accompanying drawings. It is only for the convenience of describing the present invention and simplifying the description, and does not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation. Therefore, it cannot be understood as a limitation on the present invention. The terms "connection", "installation", "fixation", etc. should be understood in a broad sense. For example, "connection" can be a fixed connection, a detachable connection, or an integral connection; it can be directly connected or indirectly connected through an intermediate medium. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0271] In the description of the present invention, the description of the terms "one embodiment", "some embodiments", "specific embodiments", etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In the present invention, the schematic representation of the above terms does not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described can be combined in any one or more embodiments or examples in a suitable manner.
[0272] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.
Claims
1. A position detection method, applied to a robot system, characterized in that: The robot system comprises a base station and a robot, the base station comprises a first charging element, the robot comprises a second charging element, and the method comprises: Acquire a detection signal indicating that the robot is at a current position, wherein the detection signal indicating the current position includes a first signal and a second signal, the first signal being used to indicate that the second charging element is in contact with the first charging element, and the second signal being used to indicate that the second charging element is separated from the first charging element; When it is detected that the detection signal of the current position changes from the first signal to the second signal, starting timing; After the timing duration reaches the preset duration, if the acquired detection signal of the current position is still the second signal, the second signal is sent to the robot.
2. The position detection method according to claim 1, characterized in that: The step of obtaining a detection signal indicating that the robot is at a current position comprises: Acquiring a load signal of the base station; determining a comparison result between a signal value of the load signal and a threshold value; The detection signal of the current position is determined to be the first signal or the second signal according to the comparison result.
3. The position detection method according to claim 2, characterized in that: The signal value includes a load current value and a load voltage value, and the threshold includes a current threshold and a voltage threshold; The step of determining, according to the comparison result, whether the detection signal of the current position is the first signal or the second signal comprises: When the load current value is less than or equal to the current threshold, and the load voltage value is less than or equal to the voltage threshold, determining that the detection signal of the current position is the first signal; When the load current value is greater than the current threshold and the load voltage value is greater than the voltage threshold, the detection signal of the current position is determined to be the second signal.
4. The position detection method according to claim 2, characterized in that: The load signal includes N consecutive signal values, where N is a positive integer; The step of determining a comparison result between a signal value of the load signal and a threshold value comprises: respectively determining N comparison results of the N signal values with the threshold value; The step of determining, according to the comparison result, whether the detection signal of the current position is the first signal or the second signal comprises: When, among the N comparison results, the number of comparison results satisfying the preset condition corresponding to the first signal is greater than or equal to the number of comparison results satisfying the preset condition corresponding to the second signal, determining that the detection signal of the current position is the first signal; When, among the N comparison results, the number of comparison results that satisfy the preset condition corresponding to the first signal is less than the number of comparison results that satisfy the preset condition corresponding to the second signal, it is determined that the detection signal of the current position is the second signal.
5. The position detection method according to claim 3, characterized in that: The current threshold value has a value range of: greater than or equal to 20 mA and less than or equal to 40 mA; The voltage threshold has a value range of greater than or equal to 2.1V and less than or equal to 4V.
6. The position detection method according to claim 4, characterized in that: The value range of N is: 25≤N≤55.
7. The position detection method according to any one of claims 1 to 6, characterized in that: The robot also includes running wheels; After the step of sending the second signal to the robot, the position detection method further includes: When the working mode of the robot is the first mode and no lifting signal of the running wheel is detected, the robot is controlled to move toward the first charging element for a preset number of times.
8. The position detection method according to claim 7, characterized in that: The first mode includes: a dust collection mode, a drying mode or a hair cutting mode.
9. The position detection method according to any one of claims 1 to 6, characterized in that: The robot also includes running wheels and a cleaning component; After the step of sending the second signal to the robot, the position detection method further includes: When the working mode of the robot is the second mode and no lifting signal of the running wheel is detected, controlling the robot to move in a direction close to the first charging element for the preset number of times; When the robot receives the second signal again after moving the preset number of times, controlling the robot to stop working and perform a reminder operation; Wherein, the second mode is a self-cleaning mode of the cleaning component.
10. The position detection method according to claim 9, characterized in that: The reminder operation includes: Announce a preset reminder message; and / or The preset reminder information is sent to the target terminal.
11. A position detection device, applied to a robot system, characterized in that: The robot system comprises a base station and a robot, the base station comprises a first charging element, the robot comprises a second charging element, and the position detection device comprises: an acquisition module, used to acquire a detection signal of the robot being at a current position, wherein the detection signal of the current position includes a first signal and a second signal, the first signal is used to indicate that the second charging element is in contact with the first charging element, and the second signal is used to indicate that the second charging element is separated from the first charging element; A timing module, configured to start timing when detecting that the detection signal of the current position changes from the first signal to the second signal; The sending module is used to send the second signal to the robot when the detection signal of the current position obtained is still the second signal after the timing duration reaches a preset duration.
12. A position detection device, characterized in that: include: Memory, used to store programs or instructions; A processor, configured to implement the steps of the position detection method according to any one of claims 1 to 10 when executing the program or instruction.
13. A readable storage medium, characterized in that: The readable storage medium stores a program or an instruction, and when the program or the instruction is executed by a processor, the steps of the position detection method according to any one of claims 1 to 10 are implemented.
14. A computer program product, the computer program product being stored in a storage medium, characterized in that: When the computer program product is executed by at least one processor, the steps of the position detection method according to any one of claims 1 to 10 are implemented.
15. A robot system, characterized in that: include: The position detection device as claimed in claim 11 or 12; and / or The readable storage medium according to claim 13; and / or The computer program product of claim 14.
