CN114915036A - Foot type robot charging control method and foot type robot - Google Patents
Foot type robot charging control method and foot type robot Download PDFInfo
- Publication number
- CN114915036A CN114915036A CN202110179022.9A CN202110179022A CN114915036A CN 114915036 A CN114915036 A CN 114915036A CN 202110179022 A CN202110179022 A CN 202110179022A CN 114915036 A CN114915036 A CN 114915036A
- Authority
- CN
- China
- Prior art keywords
- charging device
- charging
- matched
- robot
- foot type
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 43
- 238000001514 detection method Methods 0.000 claims abstract description 44
- 230000000712 assembly Effects 0.000 claims description 3
- 238000000429 assembly Methods 0.000 claims description 3
- 230000009286 beneficial effect Effects 0.000 abstract description 2
- 210000002414 leg Anatomy 0.000 description 29
- 238000010586 diagram Methods 0.000 description 6
- 230000006870 function Effects 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 206010063385 Intellectualisation Diseases 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000003491 array Methods 0.000 description 1
- 244000309466 calf Species 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000002604 ultrasonography Methods 0.000 description 1
- 210000000689 upper leg Anatomy 0.000 description 1
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02J—CIRCUIT ARRANGEMENTS OR SYSTEMS FOR SUPPLYING OR DISTRIBUTING ELECTRIC POWER; SYSTEMS FOR STORING ELECTRIC ENERGY
- H02J50/00—Circuit arrangements or systems for wireless supply or distribution of electric power
- H02J50/10—Circuit arrangements or systems for wireless supply or distribution of electric power using inductive coupling
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0225—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0242—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0253—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- H—ELECTRICITY
- H01—ELECTRIC ELEMENTS
- H01M—PROCESSES OR MEANS, e.g. BATTERIES, FOR THE DIRECT CONVERSION OF CHEMICAL ENERGY INTO ELECTRICAL ENERGY
- H01M10/00—Secondary cells; Manufacture thereof
- H01M10/42—Methods or arrangements for servicing or maintenance of secondary cells or secondary half-cells
- H01M10/44—Methods for charging or discharging
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02J—CIRCUIT ARRANGEMENTS OR SYSTEMS FOR SUPPLYING OR DISTRIBUTING ELECTRIC POWER; SYSTEMS FOR STORING ELECTRIC ENERGY
- H02J50/00—Circuit arrangements or systems for wireless supply or distribution of electric power
- H02J50/90—Circuit arrangements or systems for wireless supply or distribution of electric power involving detection or optimisation of position, e.g. alignment
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02J—CIRCUIT ARRANGEMENTS OR SYSTEMS FOR SUPPLYING OR DISTRIBUTING ELECTRIC POWER; SYSTEMS FOR STORING ELECTRIC ENERGY
- H02J7/00—Circuit arrangements for charging or depolarising batteries or for supplying loads from batteries
- H02J7/00032—Circuit arrangements for charging or depolarising batteries or for supplying loads from batteries characterised by data exchange
- H02J7/00036—Charger exchanging data with battery
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02J—CIRCUIT ARRANGEMENTS OR SYSTEMS FOR SUPPLYING OR DISTRIBUTING ELECTRIC POWER; SYSTEMS FOR STORING ELECTRIC ENERGY
- H02J7/00—Circuit arrangements for charging or depolarising batteries or for supplying loads from batteries
- H02J7/00032—Circuit arrangements for charging or depolarising batteries or for supplying loads from batteries characterised by data exchange
- H02J7/00045—Authentication, i.e. circuits for checking compatibility between one component, e.g. a battery or a battery charger, and another component, e.g. a power source
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02J—CIRCUIT ARRANGEMENTS OR SYSTEMS FOR SUPPLYING OR DISTRIBUTING ELECTRIC POWER; SYSTEMS FOR STORING ELECTRIC ENERGY
- H02J7/00—Circuit arrangements for charging or depolarising batteries or for supplying loads from batteries
- H02J7/0047—Circuit arrangements for charging or depolarising batteries or for supplying loads from batteries with monitoring or indicating devices or circuits
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/70—Energy storage systems for electromobility, e.g. batteries
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Power Engineering (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Acoustics & Sound (AREA)
- Manufacturing & Machinery (AREA)
- Chemical & Material Sciences (AREA)
- Chemical Kinetics & Catalysis (AREA)
- Electrochemistry (AREA)
- General Chemical & Material Sciences (AREA)
- Charge And Discharge Circuits For Batteries Or The Like (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The disclosure relates to a foot type robot charging control method and a foot type robot, wherein the method comprises the following steps: acquiring an environment image; identifying the environment image to acquire the position of a charging device; controlling the foot type robot to move to a preset range of the charging device according to the position of the charging device; and detecting the position of the charging device through a position detection assembly, and adjusting the position of the foot type robot according to the position detection result so as to enable the charging area of the foot type robot to be matched with the charging device. The method realizes the accurate matching of the charging area of the foot type robot and the charging device, and is more beneficial to the foot type robot to autonomously and quickly find the charging device for charging so as to improve the user experience.
Description
Technical Field
The disclosure relates to the technical field of robots, and in particular to a foot type robot charging control method, a foot type robot and a storage medium.
Background
With the progress of society and the development of science and technology, robots are more and more popular, and great convenience can be brought to users in many aspects. When the foot type robot carries out wireless charging, the charging device is searched through a camera in the foot type robot, so that the foot type robot is moved to the charging device, and charging is achieved. However, when a shielding object is arranged near the charging device, the charging device cannot be accurately found, so that the foot type robot cannot be well matched with the charging device, and the problems of low charging speed, long charging time and poor user experience are caused.
Disclosure of Invention
The present disclosure provides a charging control method for a foot robot, and a storage medium, which are intended to solve at least one of the technical problems in the related art to some extent.
The present disclosure proposes the following technical solutions:
an embodiment of the first aspect of the present disclosure provides a method for controlling charging of a legged robot, including:
acquiring an environment image;
identifying the environment image to acquire the position of a charging device;
controlling the foot type robot to move to a preset range of the charging device according to the position of the charging device;
and carrying out position detection on the charging device through a position detection assembly, and carrying out position adjustment on the foot type robot according to a position detection result so as to enable a charging area of the foot type robot to be matched with the charging device.
In addition, the foot robot charging control method according to the embodiment of the present disclosure may further have the following additional technical features:
according to one embodiment of the present disclosure, the position detection assembly includes a time-of-flight based TOF laser ranging sensor array including a plurality of TOF laser ranging sensors.
According to an embodiment of the present disclosure, the detecting the position of the charging device by the position detecting component includes: detecting a charging device to be matched in a preset direction through the TOF laser ranging sensor array to obtain shape information and height information of the charging device to be matched; judging whether the shape information and the height information of the charging device to be matched are matched with the shape information and the height information of the charging device; and if the position of the charging device to be matched is matched with the position of the charging device, taking the position of the charging device to be matched as the position of the charging device.
According to an embodiment of the present disclosure, further comprising: and if not, controlling the foot type robot to move in a preset horizontal direction to continuously match the charging device.
According to an embodiment of the present disclosure, the position adjusting the legged robot according to the position detection result so that the charging area of the legged robot matches the charging device includes: acquiring the position of the charging device; acquiring a position difference between the charging device and the charging area in a vertical direction; and adjusting the position of the foot type robot according to the position difference so as to enable the charging area of the foot type robot to be matched with the charging device.
According to one embodiment of the present disclosure, the charging area and the charging device are a wireless charging area and a wireless charging device.
According to an embodiment of the present disclosure, further comprising: and when the shape information and the height information of the charging device to be matched are matched with the shape information and the height information of the charging device, carrying out posture adjustment on the foot type robot so as to charge the charging area and the charging device.
According to one embodiment of the present disclosure, a leg assembly of the legged robot includes: the first leg part, the second leg part and the motor; wherein the posture adjustment of the legged robot includes: the motor controls at least one of a first included angle between the first leg part and the second leg part and a second included angle between the first leg part and the body of the foot type robot.
An embodiment of a second aspect of the present disclosure provides a legged robot, including:
the camera is used for acquiring an environment image;
the position detection component is used for detecting the position of the charging device;
the controller is used for identifying the environment image to obtain the position of a charging device, controlling the foot type robot to move to a preset range of the charging device according to the position of the charging device, and adjusting the position of the foot type robot according to a position detection result to enable a charging area of the foot type robot to be matched with the charging device.
According to one embodiment of the present disclosure, the position detection assembly includes a time-of-flight based TOF laser ranging sensor array including a plurality of TOF laser ranging sensors.
According to one embodiment of the disclosure, a charging device to be matched in a preset direction is detected through the TOF laser ranging sensor array so as to obtain shape information and height information of the charging device to be matched, wherein the controller is further configured to use the position of the charging device to be matched as the position of the charging device when the shape information and the height information of the charging device to be matched are matched with the shape information and the height information of the charging device.
According to an embodiment of the present disclosure, the controller is further configured to control the legged robot to move in a preset direction to continue to match the charging device when shape information and height information of the charging device to be matched do not match the shape information and the height information of the charging device.
According to an embodiment of the present disclosure, the controller is configured to acquire a position of the charging device, acquire a position difference between the charging device and the charging area in a vertical direction, and perform position adjustment on the legged robot according to the position difference so that the charging area of the legged robot matches the charging device.
According to one embodiment of the present disclosure, the charging area and the charging device are a wireless charging area and a wireless charging device.
According to one embodiment of the present disclosure, the legged robot includes: a head and a torso body connected to the head; a plurality of leg assemblies connected to the torso body; a plurality of components disposed within the torso body, the components including an image acquisition component, a position detection component; and a controller disposed within the torso body, the controller coupled to the plurality of components and the charging area.
According to one embodiment of the present disclosure, the legged robot further includes: a clamping assembly, wherein the clamping assembly is configured to clamp when a charging area of the legged robot is mated with the charging device.
An embodiment of a third aspect of the present disclosure provides a legged robot, including: a processor;
a memory for storing the processor-executable instructions;
wherein the processor is configured to execute the instructions to implement the legged robot charging control method as described above.
A fourth aspect of the present disclosure provides a non-transitory computer-readable storage medium having instructions stored thereon, which, when executed by a processor of a legged robot, enable the legged robot to perform the method for controlling charging of a legged robot as described above.
According to the technical scheme of the embodiment of the disclosure, the foot type robot is controlled to move to the preset range of the charging device through image recognition, then the position detection assembly is used for detecting the position of the charging device, and the position of the foot type robot is adjusted according to the position detection result so that the charging area of the foot type robot is matched with the charging device. From this, move to within charging device's the predetermined scope in order to realize thick location through controlling sufficient robot, again through carrying out position detection to charging device, carry out the position adjustment of accuracy to sufficient robot to realize the accurate matching of charging region and charging device of sufficient robot, more do benefit to sufficient robot and independently find charging device fast and charge and then improved user experience.
Additional aspects and advantages of the disclosure will be set forth in part in the description which follows and, in part, will be obvious from the description, or may be learned by practice of the disclosure.
Drawings
The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the present disclosure and, together with the description, serve to explain the principles of the disclosure and are not to be construed as limiting the disclosure.
Fig. 1 is a flow chart of a legged robot charging control method according to an embodiment of the present disclosure;
fig. 2 is a flowchart of a charging device position detection method according to an embodiment of the disclosure;
FIG. 3 is a schematic illustration of a legged robot in accordance with an embodiment of the present disclosure;
fig. 4 is a schematic diagram of determining charging device information to be matched according to an embodiment of the present disclosure;
FIG. 5 is a flow chart of a method of adjusting the position of a legged robot according to an embodiment of the present disclosure;
FIG. 6 is a flow chart of a method of pose adjustment for a legged robot in accordance with an embodiment of the present disclosure;
FIG. 7 is a schematic diagram of a pose adjustment process for a legged robot, according to an embodiment of the present disclosure;
FIG. 8 is a block diagram of a legged robot, in accordance with an embodiment of the present disclosure;
FIG. 9 is a block diagram of another legged robot in accordance with an embodiment of the present disclosure;
Detailed Description
Reference will now be made in detail to the embodiments of the present disclosure, examples of which are illustrated in the accompanying drawings, wherein like or similar reference numerals refer to the same or similar elements or elements having the same or similar functions throughout. The embodiments described below with reference to the accompanying drawings are illustrative and intended to explain the present disclosure, and should not be construed as limiting the present disclosure.
A method, a system, a legged robot, and a non-transitory computer-readable storage medium for controlling charging of a legged robot according to embodiments of the present disclosure are described below with reference to the accompanying drawings.
The legged robot according to the embodiment of the present disclosure may be a multi-degree-of-freedom legged robot, such as a biped robot, a quadruped robot, or a tripod robot, and the embodiment of the present disclosure is not limited thereto.
Fig. 1 is a flowchart of a foot robot charging control method according to an embodiment of the present disclosure, which can be applied to a foot robot charging control system, wherein the foot robot charging control system includes: the robot system comprises a charging device and a foot robot, wherein in one embodiment of the disclosure, the foot robot comprises a camera, a position detection assembly and a controller. In one embodiment of the present disclosure, the camera may be disposed at the head of the legged robot.
As shown in fig. 1, the foot robot charging control method includes the following steps S101 to S103.
S101, acquiring an environment image.
When the foot type robot senses a charging instruction, the image acquisition component of the foot type robot captures an environment image of the environment where the foot type robot is located, so that the general position area of the charging device can be located through identification and analysis of the environment image.
The manner of the foot robot sensing the charging instruction may be that the foot robot autonomously determines that recharging is required, or that a user instructs the foot robot to recharge through an interactive platform (e.g., APP, a remote controller, etc.), and so on.
For example, image acquisition components in a legged robot include, but are not limited to, 2D digital cameras, 3D sensing cameras, ultrasound cameras, infrared cameras, and the like.
The image capturing assembly may be installed at any position of the legged robot, for example, the image capturing assembly may be installed at a head position of the legged robot, a trunk position of the legged robot, or a tail position of the legged robot, which is not limited in this disclosure.
And S102, identifying the environment image to acquire the position of the charging device.
Further, in the embodiment of the present disclosure, by identifying and analyzing the acquired environment image, the charging device finds the position of the charging device.
As a possible implementation manner, feature points in the environment image may be extracted, the feature points of the obtained environment image are extracted, and then, a location point matching the feature points of the image is searched in a pre-stored location information base, so that the location of the charging device may be determined.
As another possible implementation, the location of the charging device may be determined by performing location identification on features in the environment image through SLAM (simultaneous localization and mapping). In the embodiment of the disclosure, the charging devices to be matched in the environment image may be identified by the SLAM, the cloud point maps of the charging devices to be matched in the environment image are obtained, and the shapes of the charging devices to be matched are obtained according to the cloud point maps of the charging devices to be matched. And then matching the shape of each charging device to be matched with the shape of the charging device, thereby obtaining the charging device to be matched with the shape of the charging device, and further determining the position of the charging device.
When it is required to be described, the charging device is roughly positioned in the step by means of image recognition, so that the legged robot can move to a preset range of the charging device.
And S103, controlling the foot type robot to move to a preset range of the charging device according to the position of the charging device.
The predetermined range includes, but is not limited to, the upper portion of the charging device.
For example, after the position of the charging device is determined, the legged robot can be moved to a position above the charging device according to the position of the charging device, so as to control the legged robot to move to a preset range of the charging device.
And S104, detecting the position of the charging device through the position detection assembly, and adjusting the position of the foot type robot according to the position detection result so as to enable the charging area of the foot type robot to be matched with the charging device.
In the embodiment of the disclosure, after the legged robot is moved to be within the preset range of the charging device, the position detection component is used for accurately positioning the charging device, and the position of the legged robot is adjusted so that the charging area of the legged robot is matched with the charging device.
Among embodiments of the present disclosure, the position detection component includes a Time of flight (TOF) laser ranging sensor array, wherein the TOF laser ranging sensor array includes a plurality of TOF laser ranging sensors. Among embodiments of the present disclosure, a plurality of TOF laser ranging sensors may form a large detection surface to detect a charging device.
In one embodiment of the present disclosure, the charging area and the charging device are a wireless charging area and a wireless charging device. Of course, in other embodiments of the present disclosure, the charging area and the charging device may be a contact type charging method.
In an embodiment of the disclosure, after the controller controls the legged robot to move within a preset range of the charging device, the position of the charging device may be detected by the TOF laser ranging sensor array, and after the position of the charging device is detected, in order to achieve accurate matching of the charging area and the charging device, the position of the legged robot may be adjusted according to a detection result of the position of the charging device, so that the charging area of the legged robot is matched with the charging device.
According to the charging control method of the foot robot in the embodiment of the disclosure, the foot robot is controlled to move to the preset range of the charging device through image recognition, then the position detection assembly is used for detecting the position of the charging device, and the position of the foot robot is adjusted according to the position detection result so that the charging area of the foot robot is matched with the charging device. Therefore, the foot type robot is controlled to move to the preset range of the charging device to realize coarse positioning, and then the position of the foot type robot is accurately adjusted by detecting the position of the charging device, so that the charging area of the foot type robot is accurately matched with the charging device. Through the embodiment of the disclosure, the robot can find the charging device to charge independently and quickly, and the user experience is improved.
It should be noted that, according to the embodiment of the present disclosure, whether the detected charging device to be matched is matched with the charging device may be determined through the position detection component, so as to implement position detection on the charging device. In one embodiment of the present disclosure, it may be determined whether the detected charging device to be matched is a charging device by determining whether the detected charging device to be matched shape information and height information are matched with the charging device shape information and height information.
That is, in an embodiment of the present disclosure, as shown in fig. 2, it is a flowchart of a charging device position detection method according to an embodiment of the present disclosure, and the method includes the following steps:
s201, detecting the charging device to be matched in the preset direction through the TOF laser ranging sensor array to obtain shape information and height information of the charging device to be matched.
For example, a TOF laser ranging sensor array is a 64-point or 36-point sensor array.
Wherein, the preset direction is towards the direction of the ground.
In one embodiment of the present disclosure, as shown in fig. 3, the legged robot includes a head 31, a trunk 32, a leg assembly 33, a position detection assembly 34, a camera 35, a charging area 36, wherein a TOF laser ranging sensor array 341 located in the position detection assembly 34 may be mounted on the trunk 32 of the legged robot and face the ground. After the legged robot moves within the preset range of the charging device 37, the ground is scanned by the TOF laser ranging sensor array 341 to find the charging device.
For example, as shown in fig. 4, by using a plurality of TOF laser ranging sensors in the TOF laser ranging sensor array, for example, 36 laser beams (for example, 6 × 6 points) are emitted and projected onto the surface of the charging device to be matched, the laser beams are reflected by the surface of the charging device to be matched, then the laser beams are received, and the distances from the positions of the 6 × 6 points to the TOF laser ranging sensors are respectively calculated according to the flight time of the light, so that the surface information of the charging device to be matched can be formed, and the shape information and the height information of the charging device to be matched can be obtained.
The plurality of TOF laser ranging sensors in the TOF laser ranging sensor array may be mounted on the trunk of the legged robot, or may be mounted on other parts of the legged robot, which is not limited in this disclosure.
And S202, judging whether the shape information and the height information of the charging device to be matched are matched with the shape information and the height information of the charging device.
Specifically, the shape information and the height information of the charging device to be matched are acquired, and whether the shape information and the height information of the charging device to be matched are matched with the shape information and the height information of the charging device can be further judged.
For example, the shape information and the height information of the charging device to be matched are acquired, and it is determined whether the shape information and the height information of the charging device to be matched match with the shape information and the height information of the charging device by determining whether the shape information and the height information are the same as those of the charging device.
For another example, the shape information and the height information of the charging device to be matched are acquired, and whether the shape information and the height information of the charging device to be matched are matched with the shape information and the height information of the charging device is determined by judging whether the shape information and the height information are in the preset range information of the shape information and the height information of the charging device.
For another example, the shape information and the height information of the charging device to be matched are acquired, and whether the shape information and the height information of the charging device to be matched are matched with the shape information and the height information of the charging device is determined based on the corresponding relationship between the shape information and the height information in the preset table and the shape information and the height information of the base.
And S203, if the shape information and the height information of the charging device to be matched are matched with the shape information and the height information of the charging device, taking the position of the charging device to be matched as the position of the charging device.
Specifically, it is determined that the shape information and the height information of the charging device to be matched match with the shape information and the height information of the charging device, and the position of the charging device to be matched may be taken as the position of the charging device.
And S204, if the shape information and the height information of the charging device to be matched are not matched with the shape information and the height information of the charging device, controlling the foot type robot to move in the horizontal direction of the preset direction so as to continuously match the charging device.
In an embodiment of the present disclosure, when it is determined that the shape information and the height information of the charging device to be matched do not match with the shape information and the height information of the charging device, the legged robot is controlled to move in the left and right directions of the legged robot to continue to match the charging device until the shape information and the height information of the charging device to be matched match with the shape information and the height information of the charging device are successfully matched, and when the matching is successful, the position of the charging device to be matched is used as the position of the charging device. According to the present disclosure, since the preliminary position of the charging device is determined by performing image recognition on the environment image, and the legged robot is moved to be within the preset range of the charging device, it is more accurate in the front-rear direction of the robot, and thus if an unmatched situation occurs, it is further searched in the left-right direction. It should be noted that, the above-mentioned continuous search in the left-right direction is only an example, and in other embodiments of the present disclosure, the search may be performed in front, back, left, and right directions. In other embodiments of the present disclosure, the height of the foot robot may be adjusted to match the searching in the front, back, left, and right directions.
It is understood that, in step S204, the position of the charging device to be matched is taken as the position of the charging device, and then, in order to achieve the precise matching of the multiple charging areas and the charging device, the position of the legged robot may be adjusted based on the determination of the position of the charging device, so that the charging area of the legged robot is successfully matched with the charging device, thereby achieving the charging control of the legged robot.
That is, in an embodiment of the present disclosure, as shown in fig. 5, there is a flowchart of a method for adjusting a position of a legged robot according to an embodiment of the present disclosure, where the method includes the following steps:
s501, the position of the charging device is obtained.
S502, a position difference in a vertical direction between the charging device and the charging area is acquired.
For example, the position of the charging device is acquired, and the distance between the charging device and the charging area may be detected by a distance sensor to determine a position difference in the vertical direction between the charging device and the charging area.
And S503, adjusting the position of the foot type robot according to the position difference so that the charging area of the foot type robot is matched with the charging device.
For example, after the position difference in the vertical direction between the charging device and the charging area is determined, it may be determined whether the position difference is within a preset position difference range, and if not, the position of the legged robot may be adjusted so that the position difference between the charging area of the legged robot and the charging device in the vertical direction is within the preset position difference range, thereby realizing the matching between the charging area of the legged robot and the charging device, and realizing the wireless charging of the legged robot.
When the position difference is judged to be within the preset position difference range, the position of the foot type robot does not need to be adjusted, so that the charging area of the foot type robot is matched with the charging device, and the wireless charging of the foot type robot is realized.
That is, in one embodiment of the present disclosure, the posture of the legged robot can be adjusted in addition to the forward, backward, leftward, and rightward movements of the legged robot mentioned in the above embodiments. As shown in fig. 6, which is a flowchart of a method for adjusting a posture of a legged robot according to an embodiment of the present disclosure, the method includes the following steps:
and S601, when the shape information and the height information of the charging device to be matched are matched with those of the charging device, carrying out posture adjustment on the foot type robot so as to charge the charging area and the charging device.
Wherein, sufficient robot includes the leg subassembly, and wherein, the leg subassembly includes: the first leg part, the second leg part and the motor; wherein, the leg assembly is attached to the charging device.
The posture of the foot type robot is adjusted by adjusting at least one of a first included angle between the first leg part and the second leg part and a second included angle between the first leg part and the body of the foot type robot, so that the charging area and the charging device are in contact alignment, and the charging area and the charging device are charged.
For example, when the shape information and the height information of the charging device a to be matched match with the shape information and the height information of the charging device a, as shown in fig. 7(a), the charging device a and the charging area B are in a misaligned condition, at this time, the distance value between the charging device a and the charging area B is W, for example, the value of W may be 888888;
then, by a motor arranged on the leg assembly, an included angle between the first leg and the second leg is controlled, or a second included angle between the first leg and the body of the legged robot is controlled, so as to bend the first leg first and then contract the second leg, or contract the second leg first and then retract the first leg, or directly change the first leg into a squatting state, for example, the first leg may be a thigh, and the second leg may be a calf, that is, as shown in fig. 7(B), the charging device a and the charging area B are in an alignment process, wherein a distance value between the charging device a and the charging area B is T, and the T value may be 688668;
after the motor control by the leg assembly is completed, it is realized that the charging device a and the charging area B are aligned as shown in fig. 7(c), wherein the distance between the charging device a and the charging area B has a value P, which may be 886668.
In one embodiment of the present disclosure, when the charging area of the legged robot is matched with the charging device, the charging area of the legged robot and the charging device can be further clamped by a clamping assembly disposed in the legged robot, so that the charging area of the legged robot and the charging device are more stable during charging.
For example, the clamping assembly may be a magnetic structure, and correspondingly, when a magnet is disposed in a charging area of the foot robot, the charging area and the charging device may be attracted by a magnetic principle to be positioned and aligned with the wireless coil, so that the charging area of the foot robot and the charging device are charged,
in summary, in the charging control method for the legged robot in the embodiment of the present disclosure, the environment image is first obtained and recognized to obtain the position of the charging device, then the legged robot is controlled to move to the preset range of the charging device according to the position of the charging device, the charging device to be matched in the preset direction is detected by the TOF laser ranging sensor array to obtain the shape information and the height information of the charging device to be matched, and it is determined whether the shape information and the height information of the charging device to be matched are matched with the shape information and the height information of the charging device; and if the charging device is matched with the charging device, taking the position of the charging device to be matched as the position of the charging device, and then adjusting the position of the foot type robot according to the position difference by acquiring the position difference between the charging device and the charging area in the vertical direction so as to match the charging area of the foot type robot with the charging device. The method realizes the accurate matching of the charging area of the foot type robot and the charging device, and is more beneficial to the foot type robot to autonomously and quickly find the charging device for charging. Through the embodiment of the disclosure, the charging speed is increased, the charging efficiency is increased, the intelligence is improved, the autonomous recharging is realized, the automatic charging alignment is realized, and the user experience is improved.
The embodiment of the disclosure also provides a foot type robot. Fig. 8 is a block diagram of a legged robot in accordance with an embodiment of the present disclosure.
As shown in fig. 8, the legged robot 80 includes a camera 81, a position detection assembly 82, and a controller 83. Wherein,
a camera 81 for acquiring an environment image;
a position detection component 82, configured to perform position detection on the charging device;
and the controller 83 is configured to identify the environment image to obtain a position of the charging device, control the legged robot to move within a preset range of the charging device according to the position of the charging device, and adjust the position of the legged robot according to a position detection result so that a charging area of the legged robot matches the charging device.
In one embodiment of the present disclosure, the position detection component 82 includes a time-of-flight based TOF laser ranging sensor array including a plurality of TOF laser ranging sensors.
In an embodiment of the present disclosure, the TOF laser ranging sensor array is used for detecting a charging device to be matched in a preset direction to obtain shape information and height information of the charging device to be matched, wherein the controller 83 is further configured to use the position of the charging device to be matched as the position of the charging device when the shape information and the height information of the charging device to be matched are matched with the shape information and the height information of the charging device.
In an embodiment of the present disclosure, the controller 83 is further configured to control the legged robot to move in a preset direction to continue to match the charging device when the shape information and the height information of the charging device to be matched do not match the shape information and the height information of the charging device.
In an embodiment of the present disclosure, the controller 83 is configured to obtain a position of the charging device, obtain a position difference between the charging device and the charging area in a vertical direction, and perform position adjustment on the legged robot according to the position difference so that the charging area of the legged robot matches the charging device.
In one embodiment of the present disclosure, the charging area and the charging device are a wireless charging area and a wireless charging device.
In one embodiment of the present disclosure, the legged robot includes: a head and a torso body connected to the head; a plurality of leg assemblies connected to the torso body; a plurality of components disposed within the torso body, the components including an image acquisition component, a position detection component; and a controller disposed within the torso body, the controller coupled to the plurality of components and the charging area.
In one embodiment of the present disclosure, the legged robot further comprises: a clamping assembly, wherein the clamping assembly is used for clamping when a charging area of the foot robot is matched with the charging device.
Fig. 9 is a block diagram of a legged robot in accordance with an embodiment of the present disclosure.
As shown in fig. 9, the foot robot 200 includes: a memory 210 and a processor 220, and a bus 230 connecting the various components, including the memory 210 and the processor 220.
Wherein, the memory 210 is used for storing the executable instructions of the processor 220; the processor 201 is configured to call and execute the executable instructions stored in the memory 202 to implement the legged robot charging control method proposed by the above-mentioned embodiments of the present disclosure.
The legged robot 200 typically includes a variety of legged robot readable media. These media may be any available media that can be accessed by the legged robot 200 and include both volatile and nonvolatile media, removable and non-removable media.
A program/utility 280 having a set (at least one) of program modules 270, including but not limited to an operating system, one or more application programs, other program modules, and program data, each of which or some combination thereof may comprise an implementation of a network environment, may be stored in, for example, the memory 210. The program modules 270 generally perform the functions and/or methodologies of the embodiments described in this disclosure.
The legged robot 200 may also communicate with one or more external devices 290 (e.g., keyboard, pointing device, display 291, etc.), with one or more devices that enable a user to interact with the legged robot 200, and/or with any devices (e.g., network card, modem, etc.) that enable the legged robot 200 to communicate with one or more other computing devices. Such communication may occur via input/output (I/O) interfaces 292. Also, the legged robot 200 may communicate with one or more networks (e.g., a Local Area Network (LAN), a Wide Area Network (WAN), and/or a public network, such as the internet) via the network adapter 293. As shown, the network adapter 293 communicates with the other modules of the legged robot 200 via the bus 230. It should be appreciated that although not shown in the figures, other hardware and/or software modules may be used in conjunction with the legged robot 200, including but not limited to: microcode, device drivers, redundant processing units, external disk drive arrays, RAID systems, tape drives, and data backup storage systems, among others.
The processor 220 executes various functional applications and data processing by executing programs stored in the memory 210.
It should be noted that, for the implementation process of the legged robot according to the embodiment of the present disclosure, reference is made to the foregoing explanation of data processing according to the embodiment of the present disclosure, and details are not described here.
The foot robot of the embodiment of the disclosure realizes the accurate matching of the charging area of the foot robot and the charging device when the processor calls and executes the executable instruction stored in the memory, so as to charge the foot robot, improve the charging speed, simultaneously improve the charging efficiency, further improve the intellectualization, realize the autonomous recharging, realize the automatic charging alignment and improve the user experience.
In order to achieve the above embodiments, the embodiments of the present disclosure also propose a non-transitory computer readable storage medium, where instructions executed by a processor of a legged robot enable the legged robot to execute the legged robot charging control method as described above.
In order to achieve the above embodiments, the embodiments of the present disclosure further provide a computer program product, which, when executed by a processor of a legged robot, enables the legged robot to execute the legged robot charging control method as described above.
Other embodiments of the disclosure will be apparent to those skilled in the art from consideration of the specification and practice of the disclosure disclosed herein. This disclosure is intended to cover any variations, uses, or adaptations of the disclosure following, in general, the principles of the disclosure and including such departures from the present disclosure as come within known or customary practice within the art to which the disclosure pertains. It is intended that the specification and examples be considered as exemplary only, with a true scope and spirit of the disclosure being indicated by the following claims.
It will be understood that the present disclosure is not limited to the precise arrangements that have been described above and shown in the drawings, and that various modifications and changes may be made without departing from the scope thereof. The scope of the present disclosure is limited only by the appended claims.
Claims (18)
1. A method for controlling charging of a legged robot, comprising:
acquiring an environment image;
identifying the environment image to acquire the position of a charging device;
controlling the foot type robot to move to a preset range of the charging device according to the position of the charging device;
and detecting the position of the charging device through a position detection assembly, and adjusting the position of the foot type robot according to the position detection result so as to enable the charging area of the foot type robot to be matched with the charging device.
2. The method of claim 1, wherein the position detection component comprises a time-of-flight based TOF laser ranging sensor array comprising a plurality of TOF laser ranging sensors.
3. The method of claim 2, wherein the detecting the position of the charging device by a position detection component comprises:
detecting a charging device to be matched in a preset direction through the TOF laser ranging sensor array to obtain shape information and height information of the charging device to be matched;
judging whether the shape information and the height information of the charging device to be matched are matched with the shape information and the height information of the charging device;
and if the position of the charging device to be matched is matched with the position of the charging device, taking the position of the charging device to be matched as the position of the charging device.
4. The method of claim 3, further comprising:
and if not, controlling the foot type robot to move in a preset horizontal direction to continuously match the charging device.
5. The method of any one of claims 1-4, wherein the adjusting the position of the legged robot based on the position detection to match a charging area of the legged robot to the charging device comprises:
acquiring the position of the charging device;
acquiring a position difference between the charging device and the charging area in a vertical direction;
and adjusting the position of the foot type robot according to the position difference so as to enable the charging area of the foot type robot to be matched with the charging device.
6. The method of claim 1, wherein the charging area and the charging device are a wireless charging area and a wireless charging device.
7. The method of claim 3, further comprising:
and when the shape information and the height information of the charging device to be matched are matched with the shape information and the height information of the charging device, carrying out posture adjustment on the foot type robot so as to charge the charging area and the charging device.
8. The method of claim 7, wherein the legged robot includes a leg assembly, wherein the leg assembly comprises: the first leg part, the second leg part and the motor;
wherein the posture adjustment of the legged robot includes: the motor controls at least one of a first included angle between the first leg part and the second leg part and a second included angle between the first leg part and the body of the foot type robot.
9. A foot-type robot is characterized in that,
the camera is used for acquiring an environment image;
the position detection component is used for detecting the position of the charging device;
the controller is used for identifying the environment image to obtain the position of a charging device, controlling the foot type robot to move to a preset range of the charging device according to the position of the charging device, and adjusting the position of the foot type robot according to a position detection result to enable a charging area of the foot type robot to be matched with the charging device.
10. The legged robot of claim 9, wherein the position detection component includes a time-of-flight based TOF laser ranging sensor array including a plurality of TOF laser ranging sensors.
11. The legged robot according to claim 10, wherein the TOF laser ranging sensor array detects a charging device to be matched in a preset direction to obtain shape information and height information of the charging device to be matched, and the controller is further configured to use a position of the charging device to be matched as the position of the charging device when the shape information and the height information of the charging device to be matched match with the shape information and the height information of the charging device.
12. The legged robot according to claim 11, wherein the controller is further adapted to control the legged robot to move in a preset direction to continue to match the charging device when shape information and height information of the charging device to be matched do not match the shape information and the height information of the charging device.
13. The foot robot according to claim 9, wherein the controller is configured to acquire a position of the charging device, acquire a position difference in a vertical direction between the charging device and the charging area, and perform position adjustment of the foot robot according to the position difference so that the charging area of the foot robot matches the charging device.
14. The legged robot according to claim 9, wherein the charging area and the charging device are a wireless charging area and a wireless charging device.
15. The legged-type robot according to claim 9, comprising:
a head and a torso body connected to the head;
a plurality of leg assemblies connected to the torso body;
a plurality of components disposed within the torso body, the components including an image acquisition component, a position detection component; and
a controller disposed within the torso body, the controller coupled to the plurality of components and the charging area.
16. The legged robot according to claim 9, further comprising: a clamping assembly, wherein the clamping assembly is configured to clamp when a charging area of the legged robot is mated with the charging device.
17. A legged robot, comprising:
a processor;
a memory for storing the processor-executable instructions;
wherein the processor is configured to execute the instructions to implement the legged robot charging control method of any of claims 1-8.
18. A non-transitory computer-readable storage medium, wherein instructions in the storage medium, when executed by a processor of a legged robot, enable the legged robot to perform the legged robot charging control method of any of claims 1-8.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110179022.9A CN114915036A (en) | 2021-02-09 | 2021-02-09 | Foot type robot charging control method and foot type robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110179022.9A CN114915036A (en) | 2021-02-09 | 2021-02-09 | Foot type robot charging control method and foot type robot |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114915036A true CN114915036A (en) | 2022-08-16 |
Family
ID=82760911
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110179022.9A Pending CN114915036A (en) | 2021-02-09 | 2021-02-09 | Foot type robot charging control method and foot type robot |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114915036A (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109428351A (en) * | 2017-08-22 | 2019-03-05 | 苏州宝时得电动工具有限公司 | Wireless charging system |
CN110838144A (en) * | 2018-08-15 | 2020-02-25 | 杭州萤石软件有限公司 | Charging equipment identification method, mobile robot and charging equipment identification system |
CN111625005A (en) * | 2020-06-10 | 2020-09-04 | 浙江欣奕华智能科技有限公司 | Robot charging method, robot charging control device and storage medium |
CN112055553A (en) * | 2018-04-30 | 2020-12-08 | Lg电子株式会社 | Sweeper and control method thereof |
-
2021
- 2021-02-09 CN CN202110179022.9A patent/CN114915036A/en active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109428351A (en) * | 2017-08-22 | 2019-03-05 | 苏州宝时得电动工具有限公司 | Wireless charging system |
CN112055553A (en) * | 2018-04-30 | 2020-12-08 | Lg电子株式会社 | Sweeper and control method thereof |
CN110838144A (en) * | 2018-08-15 | 2020-02-25 | 杭州萤石软件有限公司 | Charging equipment identification method, mobile robot and charging equipment identification system |
CN111625005A (en) * | 2020-06-10 | 2020-09-04 | 浙江欣奕华智能科技有限公司 | Robot charging method, robot charging control device and storage medium |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107990899B (en) | Positioning method and system based on SLAM | |
WO2022078467A1 (en) | Automatic robot recharging method and apparatus, and robot and storage medium | |
CN110632915B (en) | Robot recharging path planning method, robot and charging system | |
Goncalves et al. | A visual front-end for simultaneous localization and mapping | |
Cao et al. | Dynamic omnidirectional vision for mobile robots | |
JP7036400B2 (en) | Vehicle position estimation device, vehicle position estimation method, and vehicle position estimation program | |
US20170261975A1 (en) | Systems and methods employing coded light to dock aerial drones, self-driving cars and surface robots | |
CN110597265A (en) | Recharging method and device for sweeping robot | |
CN116278880A (en) | Charging equipment and method for controlling mechanical arm to charge | |
CN110838144B (en) | Charging equipment identification method, mobile robot and charging equipment identification system | |
CN113052907B (en) | Positioning method of mobile robot in dynamic environment | |
US20230344979A1 (en) | Wide viewing angle stereo camera apparatus and depth image processing method using the same | |
CN114013307A (en) | Vehicle charging method and device and electronic equipment | |
KR102275083B1 (en) | Robotic systems and a returning method of robot for automatic charging | |
CN114434123B (en) | Method and device for positioning and disassembling mechanical arm of aerial wire clamp and storage medium | |
JP2003281552A (en) | Image processor and method | |
JP2022105491A (en) | System for refining six-degrees-of-freedom pose estimate of target object | |
CN113359712A (en) | Charging docking method and device and charging pile | |
CN114915036A (en) | Foot type robot charging control method and foot type robot | |
JPS63124114A (en) | Recognizing device for environment of traveling object | |
JP7056840B2 (en) | Vehicle position estimation device, vehicle position estimation method, and vehicle position estimation program | |
CN113223077A (en) | Method and device for automatic initial positioning based on vision-assisted laser | |
JPH06258028A (en) | Method and system for visually recognizing three dimensional position and attitude | |
JP7354528B2 (en) | Autonomous mobile device, method and program for detecting dirt on lenses of autonomous mobile device | |
CN113420661A (en) | Pose determination method, device and equipment |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |