Robot navigation system and robot movement trajectory control method
By using preset arrangement receiver and transmitting module in the robot navigation system, combined with scanning and obstacle avoidance modules, the trajectory limitation and directionless problems in conventional control methods are solved, and flexible autonomous movement trajectory control is achieved, reducing the Construction cost.
Patent Information
- Application Number
- CN202210333259.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-03-31
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2042-03-31
AI Technical Summary
The conventional control robot movement method is relatively backward, and it is too limited to the moving trajectory or cannot move according to the preset moving trajectory, which cannot meet the needs of users.
Design a robot navigation system, including a robot with mobile function and a receiver electrically connected to it, set the receiver through a preset arrangement, and use the transmitting module and control device to transmit rays to guide the robot to move, combining scanning module and avoidance The barrier module realizes autonomous movement based on the received ray signal and obstacle information.
The robot moves according to the preset moving trajectory without additional tool assistance, improves movement flexibility, reduces construction costs, and solves the problem of no directionality and trajectory limitation in conventional methods.
Smart Images

Figure CN114779763B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robots, and in particular to a robot navigation system and a robot movement trajectory control method. Background Art
[0002] With the recent advancement of sensors and the maturity of control technology, robots are no longer limited to processing components in factories, but are gradually moving from factories to daily life to help people deal with boring and repetitive tasks in daily life, such as cleaning or carrying. In addition, as the cost of various electronic parts decreases, the manufacturing cost of robots is reduced and they are commercialized, which is gaining more and more attention in the industry.
[0003] Autonomous navigation is a very important part of the robot, that is, the robot moves on its own without the user's control, usually moving on a set track, or by setting an obstacle avoidance module, moving non-directionally while avoiding obstacles. Undoubtedly, the conventional method of controlling the movement of robots is relatively backward, either too restricting the movement trajectory, or failing to move according to the preset movement trajectory, and failing to meet the needs of users. Summary of the invention
[0004] The technical problem to be solved by the present invention is that the conventional method of controlling the movement of a robot is relatively backward, overly restricts the movement trajectory or fails to move according to a preset movement trajectory. To this end, a robot navigation system and a robot movement trajectory control method are provided.
[0005] The technical solution adopted by the present invention to solve the technical problem is: construct a robot navigation system, including a robot with a mobile function, and also including a plurality of receivers electrically connected to the robot; the receivers are used to receive a ray signal and feed it back to the robot; the plurality of receivers are arranged on the robot according to a preset arrangement; the robot moves according to the corresponding receiver position receiving the ray signal;
[0006] The robot navigation system further comprises a control device for controlling the movement of the robot; the control device comprises a transmitting module, a controller connected to the transmitting module, and a communication module;
[0007] The transmitting module is used to transmit rays to guide the robot to move, and the controller is used to control the transmitting angle of the transmitting module;
[0008] The communication module is used to communicate with the robot and receive signals sent by the robot.
[0009] Preferably, the preset arrangement includes: arranging R concentric plane geometric figures at intervals with the midpoint position of the top of the robot as the center; and evenly setting N rays based on the midpoint position; the R plane geometric figures intersect with the N rays to form a plurality of intersection points;
[0010] A plurality of the receivers are arranged at the midpoint of the top of the robot and at each of the intersection points.
[0011] Preferably, the plane geometric figure includes a circle, an ellipse, or a polygon.
[0012] Preferably, the robot also includes an obstacle avoidance module for detecting obstacle information; the obstacle avoidance module is connected to the controller to send the obstacle information to the controller, and the controller controls the transmitting module to change the transmitting angle according to the obstacle information.
[0013] Preferably, the control device further comprises a scanning module connected to the controller;
[0014] The scanning module is used to scan and survey the space where the robot is located and obtain the trajectory path information of the corresponding ray. The controller controls the transmitting module to change the transmitting angle according to the trajectory path information of the ray. The present invention also constructs a robot movement trajectory control method, which is implemented based on the above-mentioned robot navigation system. The robot movement trajectory control method is applied to the robot and includes the following steps:
[0015] Detecting and receiving a radiation feedback signal from any receiver;
[0016] According to the ray feedback signal, obtaining the current position of the ray landing point;
[0017] Obtaining moving path information according to the current position of the landing point and the position information of the specific receiver;
[0018] Move according to the movement path information.
[0019] Preferably, the moving path information is obtained according to the current position of the landing point and the position information of the specific receiver, specifically:
[0020] Convert the current position of the landing point into coordinates in a coordinate system; wherein the coordinate system is established according to the arrangement of the receivers;
[0021] The moving path information is obtained according to the coordinates corresponding to the landing point.
[0022] Preferably, the coordinate system is established as follows:
[0023] Arrange R concentric planar geometric figures at intervals with the midpoint position of the top of the robot as the center; and evenly set N rays based on the midpoint position; the R planar geometric figures intersect with the N rays to form a plurality of intersection points;
[0024] A plurality of the receivers are arranged at the midpoint of the top of the robot and at each of the intersection points;
[0025] The midpoint of the top of the robot is defined as the origin, and the directions of the R plane geometric figures and the N rays are used as coordinate axes to form the coordinate system;
[0026] The ordinal numbers of the plane geometric figure and the ray corresponding to the landing point are used as coordinate axis numbers.
[0027] Preferably, the plane geometric figure includes a circle, an ellipse, or a polygon.
[0028] Preferably, obtaining the moving path information according to the coordinates corresponding to the landing point is specifically:
[0029] According to the coordinates corresponding to the landing point, obtaining the ring number and column number information of the landing point coordinates;
[0030] Obtaining the moving path information according to the ring number and column number information;
[0031] The moving path information includes the indicated direction of travel and the distance of travel.
[0032] Preferably, moving according to the moving path information is specifically:
[0033] Adjust the robot's forward direction according to the forward indication direction;
[0034] When the forward direction coincides with the forward indication direction, the forward distance of the robot is controlled according to the forward distance information.
[0035] Preferably, when the robot reaches the current position of the landing point according to the moving path information, the landing point position coincides with the specific receiver position, and the robot feeds back an arrival signal to the control device.
[0036] The present invention also constructs a robot movement trajectory control method, which is implemented based on the above-mentioned robot navigation system. The robot movement trajectory control method is applied to a control device and includes the following steps:
[0037] Scan the space where the robot is located and formulate the trajectory path information of the ray according to the preset rules;
[0038] According to the trajectory path information of the ray and the arrangement position information of the receiver, the landing point of the ray is determined and emitted to the corresponding receiver;
[0039] Receiving an arrival signal of the robot arriving at the landing point;
[0040] The next ray landing point is determined and emitted to the corresponding receiver until the end point of the ray trajectory path is reached.
[0041] The implementation of the present invention has the following beneficial effects: the present invention solves the problems that conventional methods for controlling the movement of robots are relatively backward, non-directional, overly restrictive in movement trajectory, or cannot move according to a preset movement trajectory; at the same time, the present invention can enable the robot to move according to a preset movement trajectory, and does not require additional tools such as tracks to assist in movement, thereby improving the flexibility of movement and reducing construction costs. BRIEF DESCRIPTION OF THE DRAWINGS
[0042] The present invention will be further described below with reference to the accompanying drawings and embodiments, in which:
[0043] Figure 1 is a structural block diagram of a first embodiment of a robot navigation system of the present invention;
[0044] Figure 2 is a schematic diagram of a receiver in a robot navigation system of the present invention according to a preset arrangement;
[0045] Figure 3 It is a schematic diagram of the robot movement trajectory and all the landing points of the rays in the robot navigation system of the present invention;
[0046] Figure 4 is a program flow chart of the robot movement trajectory control method of the present invention applied to the robot embodiment 2;
[0047] Figure 5 is a program flow chart of a robot movement trajectory control method according to the present invention applied to a control device embodiment 3;
[0048] Figure 6 It is a schematic diagram of the present invention in which the ray landing point is located on the top of the robot with part of the receiver omitted. DETAILED DESCRIPTION
[0049] In order to have a clearer understanding of the technical features, purposes and effects of the present invention, the specific embodiments of the present invention are now described in detail with reference to the accompanying drawings. In the following description, it should be understood that the directions or positional relationships indicated by "front", "back", "up", "down", "left", "right", "longitudinal", "horizontal", "vertical", "horizontal", "top", "bottom", "inside", "outside", "head", "tail", etc. are based on the directions or positional relationships shown in the accompanying drawings, are constructed and operated in a specific direction, and are only for the convenience of describing the present technical solution, rather than indicating that the device or element referred to must have a specific direction, and therefore cannot be understood as a limitation to the present invention.
[0050] It should also be noted that, unless otherwise clearly specified and limited, the terms such as "installed", "connected", "connected", "fixed", "set" and the like should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral one; it can be a mechanical connection or an electrical connection; it can be directly connected or indirectly connected through an intermediate medium, it can be the internal connection of two elements or the interaction relationship between two elements. When an element is referred to as being "on" or "under" another element, the element can be "directly" or "indirectly" located on the other element, or there may be one or more intermediate elements. The terms "first", "second", "third", etc. are only for the convenience of describing the present technical solution, and cannot be understood as indicating or implying relative importance or implicitly indicating the number of technical features indicated. Therefore, the features defined as "first", "second", "third", etc. can explicitly or implicitly include one or more of the features. For those of ordinary skill in the art, the specific meanings of the above terms in the present invention can be understood according to the specific circumstances.
[0051] In the following description, specific details such as specific system structures, technologies, etc. are provided for the purpose of illustration rather than limitation, so as to provide a thorough understanding of the embodiments of the present invention. However, it should be clear to those skilled in the art that the present invention may be implemented in other embodiments without these specific details. In other cases, detailed descriptions of well-known systems, devices, circuits, and methods are omitted to prevent unnecessary details from obstructing the description of the present invention.
[0052] In order to solve the technical problems that conventional methods for controlling robot movement are relatively backward, too limited in movement trajectory or unable to move according to a preset movement trajectory 111, the present invention provides a robot navigation system, wherein the robot includes but is not limited to a navigation robot, a sweeping robot and other movable robots, which can move according to the set movement trajectory 111 and do not require additional tools such as tracks to assist movement, thereby improving the flexibility of movement.
[0053] Reference Figure 1-Figure 3 As shown, Figure 1 This is a structural block diagram of the first embodiment of the robot navigation system.
[0054] like Figure 1 As shown, the robot navigation system includes a robot 11 and several receivers 12 electrically connected to the robot 11; the receivers 12 are used to receive radiation signals and feed back to the robot 11; the robot 11 moves according to the position of the corresponding receiver 12 that receives the radiation signal.
[0055] It can be understood that by setting a plurality of receivers 12 and arranging them in a preset arrangement and arranged on the robot 11; setting one of the receivers 12 as a specific receiver, the specific receiver can be used as an origin to assist the robot 11 in positioning; when the receiver 12 receives a ray signal, the robot 11 can be controlled to move according to the angle and distance formed between the specific receiver and the receiver 12 that receives the ray signal. In some embodiments, the receiver 12 includes a sensor; further, the sensor includes a photoresistor.
[0056] In the first embodiment, the preset arrangement includes:
[0057] R concentric planar geometric figures are arranged at intervals with the midpoint of the top of the robot 11 as the center of the circle; and based on the midpoint as the starting point, N rays are evenly arranged in a circular manner; the R planar geometric figures intersect with the N rays to form a plurality of intersection points; a plurality of receivers 12 are arranged at the midpoint of the top of the robot 11 and at each intersection point.
[0058] Wherein R and N are positive integers greater than 1 respectively; R and N may be equal or unequal.
[0059] Optionally, the plane geometric figure includes a circle, an ellipse, or a polygon. Figure 2 As shown, the plane geometric figure is a circle.
[0060] In other embodiments, the preset arrangement may also be:
[0061] The mesh grid arrangement method includes X1 first line segments, X2 second line segments, and multiple intersections formed by the intersection of the first line segments and the second line segments arranged equidistantly; the center of the mesh grid is the intersection of the first line segment and the second line segment, which is set at the midpoint of the top of the robot 11. A plurality of receivers 12 are set at the midpoint of the top of the robot 11 and at each intersection. The number X1 and X2 are positive integers greater than or equal to 3. Preferably, the first line segment intersects the second line segment perpendicularly, and each mesh grid unit is square; the number X1 and X2 are equal, and the entire mesh grid is square as a whole.
[0062] It can be understood that the present invention determines the specific moving position according to the position of the receiver 12, and the arrangement of the receiver 12 is particularly important. The robot 11 can be controlled to move along the moving trajectory 111 required by the user through the preset arrangement method, and the flexibility is greatly improved compared with the conventional technology. Among them, the arrangement method in the first embodiment has more angle options compared with the mesh arrangement method, and the trajectory of the robot 11 movement is more diverse.
[0063] Furthermore, the robot 11 includes a calculation module 112 for calculating movement path information according to the position of the ray landing point 221, so as to drive the robot 11 to move to the destination point.
[0064] Furthermore, the robot 11 includes an obstacle avoidance module 113 for identifying obstacles and controlling the robot 11 to avoid them.
[0065] Furthermore, the robot 11 includes a connection module 114 for communicating with external devices.
[0066] It can be understood that the present invention mainly focuses on how to control the robot 11 to move along a desired path; the structural structures of the operation module 112, obstacle avoidance module 113 and connection module 114 of the robot 11 can refer to the prior art and will not be elaborated here.
[0067] In some embodiments, a user controls a transmitter that can emit rays, and the transmitter emits rays toward one of the receivers 12 . The corresponding receiver 12 receives the ray signal and then feeds it back to the robot 11 , and the robot 11 moves according to the user's direction.
[0068] In other embodiments, the transmitter is controlled by the control device 13 to achieve automation. As in the first embodiment, the robot navigation system also includes a control device 13 for controlling the movement of the robot 11; the control device 13 can be installed at a position higher than the top of the robot 11, such as the ceiling. Of course, other positions can be installed as long as the requirement of irradiating all receivers 12 is met. The control device 13 includes a transmitting module 22 and a controller 21 connected to the transmitting module 22; the transmitting module 22 is used to emit rays to guide the forward direction of the robot 11, and the controller 21 is used to control whether the transmitting module 22 emits rays, and to control the emission angle of the transmitting module 22. Of course, the arrangement range of the receiver 12 is limited, and the total required distance can be divided into multiple unit distances. By continuously changing the position of the ray landing point 221, the function of controlling the long-distance displacement of the robot 11 can be achieved. Optionally, the transmitting module 22 includes an infrared transmitter.
[0069] Furthermore, regarding the controller 21 controlling the transmitting module 22, in some embodiments, the controller 21 controls the operation of the transmitting module 22 and its transmitting angle according to a preset program; wherein the preset program can be pre-burned into the controller 21 according to actual needs. In other embodiments, the control device 13 also includes a scanning module 23; the scanning module 23 is used to scan the space where the survey robot 11 is located, and can formulate the trajectory path information of the ray according to a preset rule in the space; the scanning module 23 is connected to the controller 21, and the trajectory path information of the ray is sent to the controller 21, and the controller 21 can control the transmitting module 22 to change the transmitting angle according to the trajectory path information of the ray. For example, Figure 3As shown, the control device 13 takes itself as the starting point and controls the robot 11 to move along a bow-shaped moving track 111 until the robot 11 walks the entire terrain; or, the robot 11 moves along a return-shaped moving track 111. Optionally, the scanning module 23 includes a camera.
[0070] Furthermore, the control device 13 also includes a communication module 24 for communicating with the robot 11; the communication module 24 is connected to the controller 21 and serves as a transfer station for communication between the control device 13 and the robot 11. In some embodiments, when the robot 11 reaches the ray landing point 221, the robot 11 can feedback to the controller 21 through the communication module 24, so that the controller 21 controls the transmitting module 22 to transmit the ray at the next position. In some embodiments, the robot 11 is provided with an obstacle avoidance module 113 for detecting obstacle information; the obstacle avoidance module 113 is connected to the controller 21 through the communication module 24 to send the obstacle information to the controller 21, and the controller 21 controls the transmitting module 22 to change the transmitting angle according to the obstacle information to avoid conflicts in the control instructions of the robot 11.
[0071] Based on the above robot navigation system, the present invention also constructs a robot movement trajectory control method; Figure 4 As shown, Figure 4 This is a program flow chart of the second embodiment of the robot movement trajectory control method of the present invention. The path control method is applied to the robot 11 and includes the following steps:
[0072] S10: Detecting and receiving a ray feedback signal from any receiver 12;
[0073] It can be understood that several receivers 12 arranged on the robot 11 can detect the signal of the radiation; when you want to control the robot 11 to move a target distance in a certain direction, the corresponding receiver 12 is irradiated by the transmitting module 22. After the receiver 12 detects the radiation signal, it generates a corresponding radiation feedback signal and feeds it back to the robot 11.
[0074] S20: acquiring the current position of the ray landing point 221 according to the ray feedback signal;
[0075] It can be understood that after receiving the ray feedback signal, the robot 11 can know which receiver 12 receives the ray signal, thereby obtaining the current position of the ray landing point 221. Because the position of the receiver 12 that receives the ray signal coincides with the current position of the ray landing point 221. Preferably, in order to reduce errors, the size of the landing point 221 is equal to or nearly equal to the size of the sensor detectable range. The detectable ranges of two adjacent sensors are tangent or non-intersecting.
[0076] S30: obtaining movement path information according to the current position of the landing point 221 and the position information of the specific receiver;
[0077] It can be understood that the specific receiver refers to the receiver 12 set as the origin among all the receivers 12; the position of the specific receiver is the starting point of the displacement of the robot 11. In this embodiment, the receiver 12 set at the midpoint of the top of the robot 11 is set as the specific receiver. Furthermore, the specific receiver is not fixed and can be switched according to actual needs; for example, if a longer displacement distance is desired during a certain irradiation, the receiver 12 set at the edge can be set as a specific receiver.
[0078] The current position of the landing point 221 can be regarded as the end point of this unit distance, and the position of the specific receiver is the starting point of this unit distance; after confirming the starting point and end point information, the moving path information can be obtained based on the computing power of the robot 11.
[0079] In some embodiments, step S30 includes the following sub-steps:
[0080] S31: Convert the current position of the landing point 221 into coordinates in a coordinate system; wherein the coordinate system is pre-established according to the arrangement of the receivers 12 .
[0081] Furthermore, the coordinate system is established according to the arrangement of the receivers 12, specifically:
[0082] Arrange R concentric plane geometric figures with the midpoint of the top of the robot 11 as the center of the circle; and arrange N rays in a circle based on the midpoint with the plane geometric figure with the largest area as the path; the R plane geometric figures intersect with the N rays to form multiple intersections; define the midpoint as the origin, and use the directions of the R plane geometric figures and the N rays as coordinate axes to form a coordinate system; the receiver 12 is set at the midpoint of the top of the robot 11 and at each intersection. Optionally, the plane geometric figure includes a circle, an ellipse, or a polygon. In this embodiment, Figure 2 As shown, the plane geometric figure is a circle.
[0083] It can be understood that the ordinal numbers of the plane geometric figures and rays corresponding to the landing points are used as the coordinate axis numbers; since the midpoint position is defined as the origin, the number of rings and columns of the midpoint position is (0, 0); the number of rings and columns of the farthest intersection point on the same ray as the midpoint position is (R, 0); the ray corresponding to the robot's forward direction is defined as the zero column, and the number of columns is defined in sequence in a clockwise or counterclockwise direction. Since N rays are set, the range of the number of columns is (0, N-1]. In this embodiment, refer to Figure 2 , define the ray extending to the right as column zero, and define the column numbers in order in a counterclockwise direction.
[0084] S32: Obtain movement path information according to the coordinates corresponding to the landing point 221.
[0085] It can be understood that when the current position of the landing point 221 is obtained, the ring number and column number information of the landing point coordinates are obtained according to the coordinates corresponding to the landing point 221; according to the ring number and column number information, the angle and distance relative to the origin position, that is, relative to the specific receiver position, can be specifically known, thereby obtaining the moving path information. The moving path information includes the forward indication direction and the forward distance information. The forward indication direction refers to the direction of the ray from the origin to the landing point coordinates; the forward distance information refers to the distance from the origin to the landing point coordinates.
[0086] S40: Move according to the moving path information.
[0087] It can be understood that the forward direction and forward distance information can be obtained from the moving path information; the forward direction of the robot 11 is adjusted according to the forward direction; when the forward direction coincides with the forward direction, the forward distance of the robot 11 is controlled according to the forward distance information. The forward direction of the robot refers to the direction in which the robot moves, which can be the direction of the ray corresponding to the zero column; the forward direction refers to the direction of the destination to which the robot needs to reach, which can be the direction of the ray from the origin to the landing point coordinates.
[0088] Furthermore, after step S40, the following steps are also included:
[0089] S50: Arriving at the current position of the landing point 221, feeding back an arrival signal to the control device 13.
[0090] It can be understood that when the robot 11 reaches the current position of the landing point 221, the landing point position coincides with the specific receiver position, which means that the robot 11 has completed a unit distance displacement; the robot 11 feeds back the arrival signal to the control device 13, and after receiving the signal, the controller 21 controls the transmitting module 22 to emit rays, which are directed to the corresponding receiver 12 again, and the robot 11 repeats step S10; the cycle is repeated until the end of the total distance is reached.
[0091] Based on the above robot navigation system, the present invention also constructs a robot movement trajectory control method; Figure 5 As shown, Figure 5 This is a program flow chart of the third embodiment of the robot movement trajectory control method of the present invention. The path control method is applied to the robot 11 and includes the following steps:
[0092] Reference Figure 5 As shown, Figure 5This is a flow chart of the third embodiment of the robot movement trajectory control method of the present invention. The robot movement trajectory control method of this embodiment is applied in the above-mentioned control device 13 to control the robot 11 according to the preset. The robot movement trajectory control method of this embodiment specifically includes:
[0093] S100: Scan the space where the robot 11 is located, and formulate the trajectory path information of the ray according to a preset rule;
[0094] It is understandable that the scanning module 23 of the control device 13 can be used to scan the space where the robot 11 is located. After scanning the space, the scanning module 23 formulates the trajectory path information of the ray according to a preset rule and sends it to the controller 21.
[0095] The preset rule refers to the rule of the scanning module 23 changing the emission angle, and may also refer to the rule of the movement of the robot 11. In some embodiments, the control device 13 takes itself as the starting point and controls the robot 11 to move in a U-shaped or bow-shaped moving trajectory 111; correspondingly, the lines connecting the ray landing points 221 of the scanning module 23 are the moving trajectory 111 of the robot 11, and the rule of the scanning module 23 changing the emission angle satisfies the robot 11 to move in a U-shaped or bow-shaped.
[0096] The trajectory path information of the ray refers to the trajectory obtained by sequentially connecting the corresponding multiple ray landing points 221 in the total movement distance of the control robot 11, wherein the movement of the robot 11 moves according to a preset rule.
[0097] In some embodiments, if the scanning range of the scanning module 23 is smaller than the space of the robot 11, a portion of the space is first scanned with the maximum scanning range, and the robot 11 is controlled to complete the movement and then rescan the second portion of the space, and the cycle continues.
[0098] Furthermore, before step S100, the following steps are also included:
[0099] S001: Identify the current position of the robot 11;
[0100] It can be understood that the communication module 24 can communicate with the robot 11 to obtain the current position of the robot 11; the transmitting module 22 can also transmit rays to a specific receiver on the robot 11 to complete the positioning.
[0101] S200: Determine the landing point 221 of the ray according to the trajectory path information of the ray and the arrangement position information of the receiver 12, and emit it to the corresponding sensor;
[0102] It can be understood that according to the trajectory path information of the ray, the path information of the total distance that the robot 11 needs to move can be obtained; since the arrangement range of the receiver 12 is generally limited, and the movement trajectory 111111 of the robot 11 is complex and changeable, the distance that the robot 11 needs to move cannot be completed by only one ray. Therefore, the required total distance can be divided into multiple unit distances, and by continuously changing the position of the ray landing point 221, the function of controlling the long-distance displacement of the robot 11 and satisfying the movement of the assumed movement trajectory 111 can be achieved.
[0103] Through the trajectory path information of the ray, the end position of the robot 11 to move in the sub-unit route is obtained, and the total route is divided into multiple unit routes. Combined with the arrangement position information of the receiver 12 and the end point of the sub-unit route, the landing point 221 of the ray directed to the corresponding sensor is determined. In some embodiments, the transmitting module 22 can continue to transmit the ray when adjusting the transmission angle, or it can stop transmitting the ray to save power consumption. In addition, the arrangement position information of the sensor and how to shoot at the sensor to make the robot 11 move can be referred to above, and will not be repeated here.
[0104] S300: receiving an arrival signal of the robot 11 arriving at the landing point 221;
[0105] It can be understood that when the robot 11 completes the movement of the sub-unit distance, the specific receiver will receive the radiation signal and feed it back to the robot 11. After receiving the radiation signal, the robot 11 sends an arrival signal to the control device 13.
[0106] S400: Determine the position of the next ray landing point 221 and shoot it toward the corresponding receiver 12 until the end point of the ray trajectory path is reached.
[0107] It can be understood that after receiving the arrival signal, the control device 13 determines the end point of the next unit distance and adjusts the emission angle of the transmitting module 22; determines the landing point of the next ray emitted to the corresponding receiver 12, and repeats this cycle until it reaches the end point of the ray trajectory path, that is, the end point of the total distance that the robot 11 needs to move.
[0108] In an alternative embodiment, referring to Figure 2 , Figure 6 As shown, the working process of the present invention is specifically described below:
[0109] A circle is selected as the plane geometry; sensors are arranged at the center position of the top of the robot 11 and at the intersection according to a preset arrangement (for the convenience of explaining the solution of the present invention, other sensors except those located at the center position are omitted).
[0110] like Figure 6As shown, the number of concentric circles R is 3, which are marked as the 0th ring, the 1st ring, and the 3rd ring from the center to the periphery respectively; the number of rays N is 11, and the ray extending to the right is defined as the zero column, and the number of columns is defined in sequence in a counterclockwise direction, which are the 0th column, the 1st column, and up to the 10th column.
[0111] When the ray landing point 221 falls on the 5th ring and the 4th column, the robot 11 first turns to the 0th column to align with the landing direction, and then moves forward until the center position coincides with the landing point 221.
[0112] In summary, the present invention adds a control device and multiple receivers on the basis of the robot, and arranges the receivers in a specific arrangement, which solves the problem that the conventional method of controlling the movement of the robot is relatively backward, non-directional, too limited in the movement trajectory, or cannot move according to the preset movement trajectory; at the same time, the present invention can realize the movement of the robot according to the preset movement trajectory, and does not require additional tools such as tracks to assist in movement, thereby improving the flexibility of movement and reducing construction costs. In addition, the specific arrangement method can realize the robot's 360° all-round trajectory movement, greatly reducing the limitations of controlling movement.
[0113] It can be understood that the above embodiments only express the preferred implementation modes of the present invention, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the patent scope of the present invention. It should be pointed out that, for ordinary technicians in this field, the above technical features can be freely combined without departing from the concept of the present invention, and several deformations and improvements can be made, which all belong to the protection scope of the present invention. Therefore, all equivalent changes and modifications made to the scope of the claims of the present invention should belong to the coverage of the claims of the present invention.
Claims
1. A robot navigation system, comprising a robot with a mobile function, It is characterized in that Also included are a number of receivers electrically connected to the robot; The receiver is used to receive the radiation signal and feed it back to the robot; a plurality of the receivers are arranged on the robot according to a preset arrangement, and the detection ranges of two adjacent sensors among the plurality of receivers are tangent or spaced apart; The robot moves according to the corresponding receiver position receiving the ray signal; The robot navigation system further comprises a control device for controlling the movement of the robot; the control device comprises a transmitting module, a controller connected to the transmitting module, and a communication module; The transmitting module is used to transmit rays to guide the movement of the robot, and the controller is used to control the transmitting angle of the transmitting module; the receiver sends a ray feedback signal to the robot when the position of the landing point of the ray coincides with its own position; the communication module is used to communicate with the robot and receive the signal sent by the robot.
2. The robot navigation system according to claim 1, It is characterized in that The preset arrangement method includes: arranging R concentric plane geometric figures with the midpoint position of the top of the robot as the center; and evenly setting N rays based on the midpoint position; the R plane geometric figures intersect with the N rays to form a plurality of intersection points; A plurality of the receivers are arranged at the midpoint of the top of the robot and at each of the intersection points.
3. The robot navigation system according to claim 2, It is characterized in that The plane geometric figure includes a circle, an ellipse, or a polygon.
4. The robot navigation system according to claim 1, It is characterized in that The robot also includes an obstacle avoidance module for detecting obstacle information; the obstacle avoidance module is connected to the controller to send the obstacle information to the controller, and the controller controls the transmitting module to change the transmitting angle according to the obstacle information.
5. The robot navigation system according to any one of claims 1 to 4, It is characterized in that The control device also includes a scanning module connected to the controller; The scanning module is used to scan and survey the space where the robot is located and obtain the trajectory path information of the corresponding ray. The controller controls the transmitting module to change the transmitting angle according to the trajectory path information of the ray.
6. A robot movement trajectory control method, implemented based on the robot navigation system according to any one of claims 1 to 5, It is characterized in that The robot movement trajectory control method is applied to the robot, comprising the following steps: Detecting and receiving a radiation feedback signal from any receiver; According to the ray feedback signal, obtaining the current position of the ray landing point; Obtaining moving path information according to the current position of the landing point and the position information of the specific receiver; Move according to the movement path information.
7. The robot movement trajectory control method according to claim 6, It is characterized in that The moving path information is obtained according to the current position of the landing point and the position information of the specific receiver, specifically: Convert the current position of the landing point into coordinates in a coordinate system; wherein the coordinate system is established according to the arrangement of the receivers; The moving path information is obtained according to the coordinates corresponding to the landing point.
8. The robot movement trajectory control method according to claim 7, It is characterized in that The establishment of the coordinate system is specifically as follows: Arrange R concentric planar geometric figures at intervals with the midpoint position of the top of the robot as the center; and evenly set N rays based on the midpoint position; the R planar geometric figures intersect with the N rays to form a plurality of intersection points; A plurality of the receivers are arranged at the midpoint of the top of the robot and at each of the intersection points; The midpoint of the top of the robot is defined as the origin, and the directions of the R plane geometric figures and the N rays are used as coordinate axes to form the coordinate system; The ordinal numbers of the plane geometric figure and the ray corresponding to the landing point are used as coordinate axis numbers.
9. The robot movement trajectory control method according to claim 8, It is characterized in that The plane geometric figure includes a circle, an ellipse, or a polygon.
10. The robot movement trajectory control method according to claim 8, It is characterized in that The obtaining of the moving path information according to the coordinates corresponding to the landing point is specifically as follows: According to the coordinates corresponding to the landing point, obtaining the ring number and column number information of the landing point coordinates; Obtaining the moving path information according to the ring number and column number information; The moving path information includes the indicated direction of travel and the distance of travel.
11. The robot movement trajectory control method according to claim 10, It is characterized in that Moving according to the moving path information is specifically: Adjust the robot's forward direction according to the forward indication direction; When the forward direction coincides with the forward indication direction, the forward distance of the robot is controlled according to the forward distance information.
12. The robot movement trajectory control method according to claim 6, It is characterized in that When the robot reaches the current position of the landing point according to the moving path information, the landing point position coincides with the specific receiver position, and the robot feeds back an arrival signal to the control device.
13. A robot movement trajectory control method, implemented based on the robot navigation system according to claim 5, It is characterized in that The robot movement trajectory control method is applied to a control device, comprising the following steps: Scan the space where the robot is located and formulate the trajectory path information of the ray according to the preset rules; According to the trajectory path information of the ray and the arrangement position information of the receiver, the landing point of the ray is determined and emitted to the corresponding receiver; Receiving an arrival signal of the robot arriving at the landing point; The next ray landing point is determined and emitted to the corresponding receiver until the end point of the ray trajectory path is reached.
