CN114296457A - Method for controlling movement of plastering robot by hand-drawn track - Google Patents
Method for controlling movement of plastering robot by hand-drawn track Download PDFInfo
- Publication number
- CN114296457A CN114296457A CN202111636314.7A CN202111636314A CN114296457A CN 114296457 A CN114296457 A CN 114296457A CN 202111636314 A CN202111636314 A CN 202111636314A CN 114296457 A CN114296457 A CN 114296457A
- Authority
- CN
- China
- Prior art keywords
- track
- robot
- computer system
- hand
- data
- 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 24
- 230000007613 environmental effect Effects 0.000 claims abstract description 7
- 238000013507 mapping Methods 0.000 claims abstract description 4
- 238000012545 processing Methods 0.000 claims description 11
- 230000008569 process Effects 0.000 claims description 6
- 230000004888 barrier function Effects 0.000 claims description 5
- 238000004891 communication Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 abstract description 6
- 230000000694 effects Effects 0.000 abstract description 4
- 230000008859 change Effects 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 206010063385 Intellectualisation Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
The invention discloses a method for controlling a plastering robot to move by a hand-drawn track, which comprises the following steps of firstly, mapping an environment map acquired by the robot onto a touch screen of a mobile phone, and manually drawing the motion track of the robot by an operator; secondly, the system evaluates the safety of the hand-drawn track and corrects unreasonable track sections; thirdly, moving the robot according to the corrected hand-drawn track; and step four, judging whether a dynamic obstacle blocks a moving path or not according to the environmental data collected by the sensor while the robot moves, and carrying out emergency obstacle avoidance according to the situation. The invention reduces the calculation amount and improves the real-time property while ensuring better path planning effect.
Description
Technical Field
The invention relates to an automatic plastering technology, in particular to a method for controlling a plastering robot to move by a hand-drawn track.
Background
At present, most plastering robots with maneuverability lack the capabilities of obstacle avoidance and path planning, the working environment of the plastering robot is particularly complex, and the plastering robot finishes a plastering task on the premise of moving to a specified target position, so the path planning technology is one of the key technologies in the intellectualization of the plastering robot.
At present, robot path planning algorithms can be divided into two categories, global path planning and local path planning. The global path planning algorithm generally needs to acquire global map information in advance, and is suitable for path planning in a static working environment; the local path planning can correct the dynamic update of the environment model by collecting the environment data, and is suitable for path planning of a dynamic working environment. The two methods are good and complement each other, so the robot path planning usually adopts a method combining global planning and local planning. However, this method has the problems of poor real-time performance, large calculation amount and high hardware requirement.
Disclosure of Invention
The invention aims to provide a method for controlling the movement of a plastering robot by a hand-drawn track, which reduces the calculated amount and improves the real-time property while ensuring better path planning effect.
The technical scheme adopted by the invention is as follows:
a hand-drawn track control plastering robot moving method adopts an upper computer system and a lower computer system; the upper computer system is a mobile phone program and has the function of drawing a track by hand, correcting the track, processing the track into data and sending the data to the lower computer system; the lower computer system comprises a movement control module and a sensing module of the robot, and has the functions of receiving the track data sent by the upper computer, controlling the robot to move according to the track data after processing, and collecting environmental information in real time in the moving process so as to realize the obstacle avoidance of the robot on the dynamic obstacle; the working steps comprise:
mapping an environment map acquired by a robot onto a touch screen of a mobile phone, and manually drawing a motion track of the robot by an operator;
secondly, the system evaluates the safety of the hand-drawn track and corrects unreasonable track sections;
thirdly, moving the robot according to the corrected hand-drawn track;
and step four, judging whether a dynamic obstacle blocks a moving path or not according to the environmental data collected by the sensor while the robot moves, and carrying out emergency obstacle avoidance according to the situation.
Further, the working steps of the upper computer system comprise:
SU1the robot acquires environment map information and communicatesSending the map data to an upper computer system through wireless communication;
SU2the upper computer system maps the environment map information to the touch screen, so that an operator can draw a track on the touch screen;
SU3correcting coordinate points which are close to the obstacle in the hand-painted track: taking out a coordinate point from the hand-drawn track at a certain distance, calculating the distance between each point and each obstacle, if the distance between the point and each obstacle is greater than a set threshold distance, taking the point as a valid point, otherwise, taking the point as an invalid point, and correcting coordinate values of all invalid points in the direction away from the obstacle until all the points are valid points;
SU4and processing the corrected track coordinate values into changes of the distance L and the azimuth angle theta between adjacent points, and sending the changes to the lower computer system.
Further, the working steps of the lower computer system comprise:
SD1setting the angular speed of the wheel during turning and the angular speed of the wheel during straight running;
SD2receiving the track data [ L, theta ] sent by the upper computer system]And calculating the turning time T of the wheel according to the datarAnd a straight-ahead time Ts；
SD3And the robot moves according to the data, and whether a dynamic barrier blocks the movement of the robot is detected in real time in the moving process.
The invention has the beneficial effects that:
the invention replaces the global planning algorithm with the experience and judgment of people, reduces the calculated amount of path planning, improves the real-time property, also enables the operation mode to become simpler and more humanized, and simultaneously, the robot can judge the dynamic barrier through the environment information collected in real time, thereby improving the adaptability of the method to the dynamic working environment; the method reduces the calculation amount and improves the real-time property while ensuring better path planning effect.
Drawings
Fig. 1 is a flowchart of a method for controlling the movement of a plastering robot by a hand-drawn track in the embodiment of the present invention.
Fig. 2 is a flowchart of the operation steps of the upper computer system in the embodiment of the present invention.
FIG. 3 shows step S in the embodiment of the present inventionU4Schematic diagram of data processing.
FIG. 4 is a flowchart of the working steps of the lower computer system in the embodiment of the present invention.
Fig. 5 is a schematic diagram of a robot turning calculation idea in the embodiment of the invention.
Detailed Description
The invention is further described below with reference to the figures and examples.
As shown in fig. 1, a method for controlling the movement of a plastering robot by a hand-drawn track adopts an upper computer system and a lower computer system; the upper computer system is a mobile phone program and has the function of drawing a track by hand, correcting the track, processing the track into data and sending the data to the lower computer system; the lower computer system comprises a movement control module and a sensing module of the robot, and has the functions of receiving the track data sent by the upper computer, controlling the robot to move according to the track data after processing, and collecting environmental information in real time in the moving process so as to realize the obstacle avoidance of the robot on the dynamic obstacle; the working steps comprise:
mapping an environment map acquired by a robot onto a touch screen of a mobile phone, and manually drawing a motion track of the robot by an operator;
secondly, the system evaluates the safety of the hand-drawn track and corrects unreasonable track sections;
thirdly, moving the robot according to the corrected hand-drawn track;
and step four, judging whether a dynamic obstacle blocks a moving path or not according to the environmental data collected by the sensor while the robot moves, and carrying out emergency obstacle avoidance according to the situation.
As shown in fig. 2, the working steps of the upper computer system include:
SU1the robot acquires environment map information and sends map data to an upper computer system through wireless communication;
SU2the upper computer system maps the environment map information to the touch screen, so that an operator can draw a track on the touch screen;
SU3correcting coordinate points which are close to the obstacle in the hand-painted track: taking out a coordinate point from the hand-drawn track at a certain distance, calculating the distance between each point and each obstacle, if the distance between the point and each obstacle is greater than a set threshold distance, taking the point as a valid point, otherwise, taking the point as an invalid point, and correcting coordinate values of all invalid points in the direction away from the obstacle until all the points are valid points;
SU4processing the corrected track coordinate value into the change of the distance L and the azimuth theta between adjacent points, and sending the change to a lower computer system;
a, B, C are the adjacent points extracted on the hand-drawn trace, respectively, as shown in FIG. 3. L is1、L2、L3Respectively, the distance between adjacent points. Theta1、θ2、θ3Respectively the azimuth angle change value of the next section of track compared with the previous section of track;
the distance L between adjacent points can be calculated from the coordinates of the points, expressed as L1For example, the following steps are carried out:
similarly, the azimuth angle change value theta can be calculated and calculated according to theta1For example, the following steps are carried out:
when the upper computer sends data, the L and theta values of all the points are sent to the lower computer, so that the lower computer has a much smaller calculation amount in processing.
As shown in fig. 4, the working steps of the lower computer system include:
SD1setting the angular speed of the wheel during turning and the angular speed of the wheel during straight running;
SD2receiving the track data [ L, theta ] sent by the upper computer system]And calculating the turning time T of the wheel according to the datarAnd a straight-ahead time Ts；
For a four-wheel differential steering plastering robot with maneuverability, as shown in fig. 5, when the turning is set, the absolute values of the angular velocities of the left wheel and the right wheel are equal and are both omega, but the directions are opposite, namely omegar＝-ωl. Knowing that the wheel distance is D and the wheel diameter is D, when the lower computer system knows that the azimuth angle change value of the robot at the moment is theta, the following steps are carried out:
when the vehicle travels straight, the distance between two adjacent points is known as L, and the rotational angular velocity ω of the straight wheel is setsTime T required for straight travelingsComprises the following steps:
SD3and the robot moves according to the data, and whether a dynamic barrier blocks the movement of the robot is detected in real time in the moving process.
The invention replaces the global planning algorithm with the experience and judgment of people, reduces the calculated amount of path planning, improves the real-time property, also enables the operation mode to become simpler and more humanized, and simultaneously, the robot can judge the dynamic barrier through the environment information collected in real time, thereby improving the adaptability of the method to the dynamic working environment; the method reduces the calculation amount and improves the real-time property while ensuring better path planning effect.
It will be understood that modifications and variations can be made by persons skilled in the art in light of the above teachings and all such modifications and variations are intended to be included within the scope of the invention as defined in the appended claims.
Claims (3)
1. A method for controlling a plastering robot to move by a hand-drawn track is characterized by comprising the following steps: an upper computer system and a lower computer system are adopted; the upper computer system is a mobile phone program and has the function of drawing a track by hand, correcting the track, processing the track into data and sending the data to the lower computer system; the lower computer system comprises a movement control module and a sensing module of the robot, and has the functions of receiving the track data sent by the upper computer, controlling the robot to move according to the track data after processing, and collecting environmental information in real time in the moving process so as to realize the obstacle avoidance of the robot on the dynamic obstacle; the working steps comprise:
mapping an environment map acquired by a robot onto a touch screen of a mobile phone, and manually drawing a motion track of the robot by an operator;
secondly, the system evaluates the safety of the hand-drawn track and corrects unreasonable track sections;
thirdly, moving the robot according to the corrected hand-drawn track;
and step four, judging whether a dynamic obstacle blocks a moving path or not according to the environmental data collected by the sensor while the robot moves, and carrying out emergency obstacle avoidance according to the situation.
2. The method of hand-drawn trajectory controlled plastering robot movement of claim 1, wherein: the working steps of the upper computer system comprise that,
SU1the robot acquires environment map information and sends map data to an upper computer system through wireless communication;
SU2the upper computer system maps the environment map information to the touch screen, so that an operator can draw a track on the touch screen;
SU3correcting coordinate points which are close to the obstacle in the hand-painted track: taking out a coordinate point from the hand-drawn track at a certain distance, calculating the distance between each point and each obstacle, if the distance between the point and each obstacle is greater than the set threshold distance, the point is a valid point, otherwise, the point is an invalid point, correcting the coordinate values of all invalid points in the direction away from the obstacle,until all points are valid points;
SU4and processing the corrected track coordinate values into changes of the distance L and the azimuth angle theta between adjacent points, and sending the changes to the lower computer system.
3. The method for hand-drawn trajectory controlled plastering robot movement of claim 2, wherein: the working steps of the lower computer system comprise that,
SD1setting the angular speed of the wheel during turning and the angular speed of the wheel during straight running;
SD2receiving the track data [ L, theta ] sent by the upper computer system]And calculating the turning time T of the wheel according to the datarAnd a straight-ahead time Ts；
SD3And the robot moves according to the data, and whether a dynamic barrier blocks the movement of the robot is detected in real time in the moving process.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111636314.7A CN114296457A (en) | 2021-12-29 | 2021-12-29 | Method for controlling movement of plastering robot by hand-drawn track |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111636314.7A CN114296457A (en) | 2021-12-29 | 2021-12-29 | Method for controlling movement of plastering robot by hand-drawn track |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN114296457A true CN114296457A (en) | 2022-04-08 |
Family
ID=80971069
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111636314.7A Pending CN114296457A (en) | 2021-12-29 | 2021-12-29 | Method for controlling movement of plastering robot by hand-drawn track |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114296457A (en) |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102087530A (en) * | 2010-12-07 | 2011-06-08 | 东南大学 | Vision navigation method of mobile robot based on hand-drawing map and path |
| CN102313547A (en) * | 2011-05-26 | 2012-01-11 | 东南大学 | Visual navigation method for mobile robot based on hand-drawn contour semantic map |
| CN108227694A (en) * | 2016-12-14 | 2018-06-29 | 株式会社久保田 | Driving path generating means |
| CN111895999A (en) * | 2020-06-29 | 2020-11-06 | 福建（泉州）哈工大工程技术研究院 | Path planning method based on structured data |
-
2021
- 2021-12-29 CN CN202111636314.7A patent/CN114296457A/en active Pending
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102087530A (en) * | 2010-12-07 | 2011-06-08 | 东南大学 | Vision navigation method of mobile robot based on hand-drawing map and path |
| CN102313547A (en) * | 2011-05-26 | 2012-01-11 | 东南大学 | Visual navigation method for mobile robot based on hand-drawn contour semantic map |
| CN108227694A (en) * | 2016-12-14 | 2018-06-29 | 株式会社久保田 | Driving path generating means |
| CN111895999A (en) * | 2020-06-29 | 2020-11-06 | 福建（泉州）哈工大工程技术研究院 | Path planning method based on structured data |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US10990099B2 (en) | Motion planning methods and systems for autonomous vehicle | |
| CN107085938B (en) | Fault-tolerant planning method of local trajectory for intelligent driving based on lane line and GPS following | |
| CN103204162B (en) | There is the Lane tracking system of effective rear steering | |
| CN110553660A (en) | unmanned vehicle trajectory planning method based on A-star algorithm and artificial potential field | |
| CN113848914B (en) | Method for planning local path by collision coefficient artificial potential field method in dynamic environment | |
| CN102788591A (en) | Visual information-based robot line-walking navigation method along guide line | |
| CN111538331A (en) | A reactive navigation method for an underground unmanned articulated vehicle | |
| CN109085840B (en) | Vehicle navigation control system and control method based on binocular vision | |
| CN114326732B (en) | Autonomous following system and autonomous following control method for robot | |
| CN110006419A (en) | Vehicle track tracking point determination method based on preview | |
| CN103454919A (en) | Motion control system and method of mobile robot in intelligent space | |
| CN113589685B (en) | Vehicle moving robot control system and method based on deep neural network | |
| CN105987697B (en) | The wheeled AGV navigation locating method of Mecanum and system under a kind of quarter bend | |
| CN111857121B (en) | Walking obstacle avoidance method and system for patrol robot based on inertial navigation and laser radar | |
| CN113252022B (en) | A method and device for processing map data | |
| CN114442630B (en) | Intelligent vehicle planning control method based on reinforcement learning and model prediction | |
| CN106886217A (en) | Autonomous navigation control method and device | |
| CN109878530A (en) | Method and system for identifying vehicle sideways driving conditions | |
| CN106767833A (en) | A kind of robot localization method of fusion RGBD depth transducers and encoder | |
| CN112650217B (en) | Robot trajectory tracking strategy dynamic optimization method based on evaluation function | |
| CN113569980B (en) | A Method and System for Online Prediction of Pedestrian Trajectories in Complex Environments | |
| CN116168075A (en) | An unmanned driving perception mapping system for mobile machines and their unstructured scenes | |
| Kong et al. | Path planning of mobile robots based on the fusion of an improved A* algorithm and a dynamic window approach | |
| CN115923839A (en) | Vehicle path planning method | |
| CN105590087A (en) | Road recognition method and device |
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 | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20220408 |
|
| RJ01 | Rejection of invention patent application after publication |