Nothing Special   »   [go: up one dir, main page]

WO2022095060A1 - Path planning method, path planning apparatus, path planning system, and medium - Google Patents

Path planning method, path planning apparatus, path planning system, and medium Download PDF

Info

Publication number
WO2022095060A1
WO2022095060A1 PCT/CN2020/127623 CN2020127623W WO2022095060A1 WO 2022095060 A1 WO2022095060 A1 WO 2022095060A1 CN 2020127623 W CN2020127623 W CN 2020127623W WO 2022095060 A1 WO2022095060 A1 WO 2022095060A1
Authority
WO
WIPO (PCT)
Prior art keywords
movable platform
image area
information
target image
semantic
Prior art date
Application number
PCT/CN2020/127623
Other languages
French (fr)
Chinese (zh)
Inventor
邹亭
赵力尧
Original Assignee
深圳市大疆创新科技有限公司
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 深圳市大疆创新科技有限公司 filed Critical 深圳市大疆创新科技有限公司
Priority to CN202080074264.5A priority Critical patent/CN114746822A/en
Priority to PCT/CN2020/127623 priority patent/WO2022095060A1/en
Publication of WO2022095060A1 publication Critical patent/WO2022095060A1/en

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions

Definitions

  • the present application relates to the field of robotics, and in particular, to a path planning method, a path planning device, a path planning system and a medium.
  • path planning operations In the field of robotics, many typical application scenarios require path planning operations. For example, path planning of drones, transport robots, etc. in closed or open environments.
  • the related art adopts a single obstacle avoidance strategy in path planning, and does not design corresponding obstacle avoidance strategies for different types of obstacles, and it is difficult to achieve more reasonable and efficient path planning in complex scenarios.
  • the embodiments of the present application provide a path planning method, a path planning device, a path planning system, and a medium, so as to realize more reasonable and efficient path planning.
  • an embodiment of the present application provides a path planning method for planning a moving path of a movable platform.
  • the method includes: first, acquiring a semantic map of the operating environment of the movable platform, and the semantics of each image area in the semantic map The information has a corresponding relationship with the obstacle avoidance strategy of the movable platform, and then, according to the semantic map, the semantic information of the target image area in the semantic map is determined. Next, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, a moving path for the movable platform to avoid the target object corresponding to the target image area is planned.
  • embodiments of the present application provide a path planning apparatus for planning a moving path of a movable platform, the apparatus comprising: one or more processors; and a computer-readable storage medium for storing one or more processors
  • a computer program when the computer program is executed by the processor, realizes: obtains the semantic map of the operating environment of the mobile platform, and the semantic information of each image area in the semantic map has a corresponding relationship with the obstacle avoidance strategy of the mobile platform; according to the semantic map, Determine the semantic information of the target image area in the semantic map; and plan the moving path of the movable platform to avoid the target object corresponding to the target image area according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area.
  • an embodiment of the present application provides a path planning system for planning a moving path, the system includes: a control terminal and a movable platform that are communicatively connected to each other, wherein the control terminal and/or the movable platform include the above Path planning device.
  • embodiments of the present application provide a computer-readable storage medium, which stores executable instructions, and when the executable instructions are executed by one or more processors, can cause one or more processors to execute the above method.
  • 1 is an application scenario of a path planning method, a path planning device, a path planning system, and a medium provided by an embodiment of the present application;
  • FIG. 2 is an application scenario of a path planning method, a path planning device, a path planning system, and a medium provided by another embodiment of the present application;
  • FIG. 3 is a schematic flowchart of a path planning method provided by an embodiment of the present application.
  • FIG. 4 is a schematic diagram of a semantic map provided by an embodiment of the present application.
  • FIG. 5 is a schematic diagram of a return origin and a return destination provided by an embodiment of the present application.
  • FIG. 6 is a schematic diagram of a user interaction interface provided by an embodiment of the present application.
  • FIG. 7 is a schematic diagram of updating a semantic map provided by an embodiment of the present application.
  • FIG. 8 is a schematic diagram of updating a semantic map according to another embodiment of the present application.
  • FIG. 9 is a schematic diagram of updating a semantic map according to another embodiment of the present application.
  • 10A is a schematic diagram of updating a semantic map according to another embodiment of the present application.
  • FIG. 10B is a schematic diagram of a movement path provided by an embodiment of the present application.
  • FIG. 11 is a schematic diagram of a safety distance provided by an embodiment of the present application.
  • FIG. 12 is a schematic diagram of a semantic map provided by another embodiment of the present application.
  • FIG. 13 is a schematic diagram of moving through obstacle information detected by a sensor provided by an embodiment of the present application.
  • FIG. 14 is a schematic diagram of updating a semantic map based on obstacle information detected by a movable platform according to an embodiment of the present application
  • FIG. 15 is a schematic diagram illustrating that the smoothness of the movement path provided by the embodiment of the application meets the maneuvering requirements of the movable platform;
  • 17 is a schematic diagram of a non-response control rod amount provided by an embodiment of the present application.
  • FIG. 18 is a schematic structural diagram of a path planning apparatus provided by an embodiment of the present application.
  • FIG. 1 is an application scenario of a path planning method, a path planning device, a path planning system, and a medium provided by an embodiment of the present application.
  • the embodiment of the present application is a path planning method based on a semantic map, which fills the technical gap of robot path planning in a stable environment, and provides an inexpensive and reusable path planning method.
  • a semantic map is exemplarily described.
  • the semantic map can be a pixel picture (it can be in tif/tfw format), each pixel in the picture corresponds to a coordinate position in the real world, and the pixel stores a semantic information corresponding to the position , marking the object type corresponding to the position.
  • a plurality of adjacent pixels with the same semantics can be collectively formed into an image area.
  • Each image region has corresponding semantic information.
  • each image area can be represented by different colors, filling patterns, etc.
  • the green pixels correspond to the semantics of farmland, indicating that the actual position corresponding to these pixels is a real object such as "farmland”.
  • the purple pixels correspond to objects like "trees”.
  • the semantic information of the image area with the origin filling pattern 1111 in the semantic map 1 is a wheat field.
  • the semantic information for the image area with the pure white fill pattern 1112 is a river.
  • the semantic information of the image area with the horizontal line fill pattern 1113 is the no-fly zone.
  • the semantic information of the image area with grid fill pattern 1114 is architecture.
  • the semantic information for the image region with the diagonal hatch pattern 1115 is cornfield.
  • the semantic information of the image area with the vertical line fill pattern 1116 is the high voltage line tower.
  • the granularity of the above semantic division is adjustable.
  • the granularity can be increased according to the needs, such as the wheat field and the corn field can be divided into the same category: crops; the high-voltage line tower can be incorporated into the building.
  • the granularity can be reduced according to requirements, for example, buildings can be divided into high-rise buildings and low-rise buildings.
  • the acquisition of the semantic map can include various methods, and the source of the semantic map is not limited.
  • semantic maps can come from aerial mapping recognition, manual delineation by users, third-party downloads, and the like.
  • a semantic map is a configuration file that can be used by multiple robotics platforms simultaneously. Since the maps loaded by the robots are the same, different robots can be guaranteed to make the same planning results under the same conditions.
  • UAVs can be consumer UAVs, agricultural UAVs, and industrial application UAVs.
  • the robot may be a road robot, an indoor robot, an aquatic robot, an underwater robot, an underwater robot, an aerial robot, etc., which is not limited herein.
  • the semantic map can be used as the input of path planning, and the obstacle avoidance strategy of the corresponding image region can be determined based on the semantic information of each image region in the semantic map, and then the path planning can be carried out based on the obstacle avoidance strategy.
  • the obstacle avoidance strategy for the image areas of the origin fill pattern 1111 and the pure white fill pattern 1112 is pass, and the obstacle avoidance strategy for the image areas of the horizontal line fill pattern 1113 and the grid fill pattern 1114 is to go around Line, the obstacle avoidance strategy for the image area of the diagonal fill pattern 1115 is to pass over.
  • the moving path of the robot in a stable environment can be easily planned, instead of relying only on the sensors carried by the robot itself for path planning, and because the environmental information given by the semantic map is highly reliable, it helps to improve the planned path. reliability.
  • the UAV 2 can move from the position corresponding to the start point 3 of the path to the position corresponding to the end point 4 of the path according to the planned movement path.
  • an obstacle avoidance strategy consists only of: passing and detouring.
  • the obstacle avoidance strategy includes passing, detouring, passing above, passing below, passing quickly, passing at low speed, etc., which are not limited here.
  • the path planning method, path planning device, path planning system and medium provided by the embodiments of the present application have a corresponding relationship between the semantic information of each image area in the semantic map and the obstacle avoidance strategy of the movable platform, so that the movable platform can be based on
  • the corresponding obstacle avoidance strategy is used for path planning, which can achieve more reasonable and efficient path planning in complex scenarios.
  • the environmental information included in the semantic map can be edited, so that the user can edit the environmental information according to the actual scene.
  • the semantic map can be modified in advance and configured according to the actual situation, which improves the flexibility of its application.
  • FIG. 2 is an application scenario of a path planning method, a path planning device, a path planning system, and a medium provided by another embodiment of the present application.
  • the working equipment 14 mounted on the movable platform 10 will be described as an example.
  • the movable platform 10 in Fig. 2 includes a main body 11, a carrier 13 and operation equipment 14 (such as plant protection equipment, surveying and mapping equipment or image capturing devices, etc.).
  • operation equipment 14 such as plant protection equipment, surveying and mapping equipment or image capturing devices, etc.
  • the mapping device may be located directly on the movable platform 10 without the need for the carrier 13 .
  • the movable platform 10 may include a power mechanism 15 , a sensing system 12 .
  • the mobile platform 10 may also include a communication system.
  • the communication system can realize the communication between the movable platform 10 and the control terminal 20 having the communication system through the wireless signal 30 sent and received by the antenna 22 , and the antenna 22 is arranged on the main body 21 .
  • a communication system may include any number of transmitters, receivers, and/or transceivers for wireless communication.
  • control terminal 20 may provide control instructions to one or more of the movable platform 10 , the carrier 13 , and the work equipment 14 , and provide control instructions from the movable platform 10 , the carrier 13 , and the work equipment 14 .
  • One or more of the received information (such as position and/or motion information of obstacles, movable platform 10, carrier 13 or work equipment 14, load sensing data, such as liquid level information, flow information, temperature information, etc.) .
  • the control data of the control terminal 20 may include instructions regarding position, movement, and braking for the control of the movable platform 10 , the carrier 13 and/or the work equipment 14 .
  • control data may cause a change in the position and/or orientation of the movable platform 10 (eg, by controlling the power mechanism 15), or cause movement of the carrier 13 relative to the movable platform 10 (eg, by controlling the carrier 13).
  • the control data of the control terminal 20 can lead to load control, such as controlling the operation of the spraying equipment (starting spraying, stopping spraying, controlling flow rate, spraying angle, spraying liquid ratio, etc.).
  • the communications of the movable platform 10, the carrier 13, and/or the work equipment 14 may include information from one or more sensors (eg, distance sensor 12, water level sensor, angle sensor, etc.).
  • Communication may include sensory information transmitted from one or more different types of sensors, such as GPS sensors, motion sensors, inertial sensors, proximity sensors, or image sensors.
  • the control data transmitted by the control terminal 20 may be used to control the state of one or more of the movable platform 10 , the carrier 13 or the work equipment 14 .
  • one or more of the carrier 13 and the work equipment 14 may include a communication module for communicating with the control terminal 20 so that the control terminal 20 can communicate with or control the movable platform 10, the carrier 13 and the work equipment individually 14.
  • the control terminal 20 may be a remote controller of the movable platform 10 , or may be an intelligent electronic device such as a mobile phone, an iPad, a wearable electronic device, etc., which can be used to control the movable platform 10 .
  • control terminal 20 can be far away from the movable platform 10 to realize remote control of the movable platform 10, and can be fixedly or detachably provided on the movable platform 10, and can be specifically set as required.
  • the removable platform 10 may communicate with other remote devices other than the control terminal 20 , or with remote devices other than the control terminal 20 .
  • the control terminal 20 may also communicate with another remote device and the movable platform 10 .
  • the movable platform 10 and/or the control terminal 20 may be in communication with another movable platform or a carrier or payload of another movable platform.
  • the additional remote device may be a second terminal or other computing device (eg, a computer, desktop, tablet, smartphone, or other mobile device).
  • the remote device may transmit data to the mobile platform 10 (eg, transmit a semantic map), receive data (eg, obstacle information) from the mobile platform 10 , transmit data to the control terminal 20 , and/or receive data from the control terminal 20 .
  • the remote device may be connected to the Internet or other telecommunication network to allow data received from the removable platform 10 and/or the control terminal 20 to be uploaded to a website or server.
  • the movable platform 10 may also be a land robot, an unmanned vehicle, an underwater robot, etc., which is not limited herein.
  • FIG. 3 is a schematic flowchart of a path planning method provided by an embodiment of the present application.
  • the path planning method for planning the moving path of the movable platform, may include operations S301 to S305 .
  • a semantic map of the operating environment of the movable platform is obtained, and the semantic information of each image area in the semantic map has a corresponding relationship with the obstacle avoidance strategy of the movable platform.
  • the semantic map may be input to the movable platform or the control terminal of the movable platform by the user.
  • the semantic map may also be automatically downloaded by the movable platform or the control terminal of the movable platform, for example, searched from the semantic map collection based on the current location information of the movable platform.
  • the semantic map may also be stored locally in the movable platform or the control terminal of the movable platform, and automatically read from the storage space after the movable platform is powered on.
  • Semantic maps can be drawn by other electronic devices or pre-drawn by themselves.
  • the semantic map may include multiple image areas, and the corresponding obstacle avoidance strategies for the respective pixels in each image area are the same.
  • the semantic information corresponding to each pixel in the wheat field area is wheat field, and the obstacle avoidance strategy corresponding to the wheat field area is pass.
  • Corresponding semantic information may be set for each pixel respectively, or only corresponding semantic information may be set for each image area, which is not limited herein.
  • the correspondence between the semantic information of the image area in the semantic map and the obstacle avoidance strategy of the mobile platform can be set by the user, by the manufacturer, or by the user who draws the semantic map.
  • the above corresponding relationship can be modified by the user, such as modifying the image area in the semantic map, modifying the semantic information of the image area, modifying the obstacle avoidance strategy corresponding to the semantic information, and the like.
  • the obstacle avoidance strategy includes at least one of a side detour strategy, an upper pass strategy, or a downward pass strategy.
  • FIG. 4 is a schematic diagram of a semantic map provided by an embodiment of the present application.
  • the semantic map includes six image areas, wherein the semantic information of each image area is: wheat field, water surface, building, no-fly zone, cornfield and high-voltage line tower.
  • the obstacle avoidance strategy corresponding to each image area can be: passing, high-speed passing, detouring, no flight, passing above, etc.
  • an operation state corresponding to the obstacle avoidance strategy may be further set.
  • the above method may further include the following operation: when the obstacle avoidance strategy includes passing over, setting the operation status of the movable platform to prohibit operation.
  • the prohibition of operations includes at least one of the following: prohibition of spraying, prohibition of photographing, prohibition of surveying and mapping, and the like. This effectively improves the convenience of setting the corresponding job status for each region of the semantic map.
  • the semantic information of the target image region in the semantic map is determined according to the semantic map.
  • the target image area may be an image area that the moving path may need to pass through.
  • the image area corresponding to the current position of the drone in the semantic map 1 is labeled 1111, and the image area labeled 1111 is the target image area.
  • the image areas marked 1113, 1114, 1112 and 1115 are the target image areas.
  • the image areas marked 1113, 1114, 1112 and 1115 are the target image areas.
  • the image area marked 1116 is not the target image area.
  • an obstacle avoidance strategy corresponding to the target image area can be determined from the semantic map based on the above-mentioned correspondence, so as to perform path planning based on the obstacle avoidance strategy.
  • determining the semantic information of the target image region in the semantic map may include the following operations. First, the target image area is determined according to the corresponding position information of the initial waypoint of the movable platform and the target waypoint in the semantic map and the semantic map. Then, according to the target image area, the semantic information of the target image area is determined.
  • the initial waypoint and the target waypoint may be set by the user. For example, if the user sets the movable platform to move from position A to position B, then position A is the initial waypoint and position B is the target waypoint.
  • the initial waypoint and the target waypoint can be automatically determined by the mobile platform.
  • the user sends the return-to-home command to the mobile platform through the control terminal, and specifies the end of the operation.
  • the return-to-home command is given and the preset task has been completed
  • the current position of the movable platform is used as the initial path point
  • the initial moving path point of the movable platform is used as the target path point.
  • the initial path point of the movable platform is the starting point of the return home
  • the target way point of the movable platform is the return end point.
  • FIG. 5 is a schematic diagram of a return-to-home origin and a return-to-home end point according to an embodiment of the present application.
  • marks corresponding to the return origin and return destination can be marked on the semantic map by means of file loading, etc.
  • the marks include but are not limited to: triangles, origins, circles, crosshairs, aiming marks, etc.
  • the return-to-home start point and the return-to-home end point can be set through user operations, for example, the user clicks two positions on the semantic map, such as one or more coordinates input by the user.
  • the return-to-home origin and return-to-home end point can be automatically set by the movable platform. For example, the starting point coordinates when the return-to-home is started is used as the return-to-home origin point, and the starting point coordinates when the movable platform starts to operate is used as the return-to-home end point.
  • the initial and target waypoints can be displayed on the semantic map.
  • the target image area by connecting the initial waypoint and the target waypoint, it can be determined which image areas the line between the two points passes through, and these image areas are used as the target image area. It should be noted that when the obstacle avoidance strategy corresponding to the target image area is detour, at least one image area adjacent to the target image area needs to be added to the target image area to form a continuous moving path.
  • determining the semantic information of the target image region in the semantic map may include the following operations. First, according to the corresponding position information of the movable platform in the semantic map and the semantic map, the target image area is determined. Then, according to the target image area, the semantic information of the target image area is determined.
  • the user controls the flight of the drone or controls the movement of the land robot by using the stick.
  • the movable platform responds to the control commands (such as forward, backward) corresponding to the stick. , turn left or right, etc.) to move.
  • the target image area can be based on the image area where the movable platform is currently located and the specified number of image areas that will intersect after extending along the current moving direction.
  • the current position of the movable platform corresponds to the current image area in the semantic map, and one or more image areas closest to the current image area along the current moving direction are used as the target image area.
  • a moving path for the movable platform to avoid the target object corresponding to the target image area is planned.
  • the movement path can be planned based on the semantic information of the target image area and the outline of the target image area. For example, in a scene with an initial waypoint and a target waypoint, the connecting line between the initial waypoint and the target waypoint can be determined. If the connecting line intersects the target image area whose semantic information is a detour, the target image area can be determined based on the target.
  • the contour of the image area generates an alternate movement path (or waypoints) in place of the segment (or waypoints) in the line that intersect the target image area.
  • the alternative movement path may be conformal or non-conformal to at least part of the contour of the target image area. A safety distance is required between the alternate movement path and the outline of this target image area.
  • the above method further includes: extracting the contours of each region of the semantic map, so as to generate a movement path based at least on the contours of the target image region. For example, for the image area corresponding to the obstacle avoidance strategy, the contour of the image area can be extracted, and then a conformal path or a smoother moving path than the conformal path can be generated based on the contour.
  • the extraction of the contour of the image region may be completed before the path planning is performed, or may be completed during the path planning process, which is not limited herein.
  • the movement path can be further optimized. For example, during the movement of the movable platform along the movement path, the following conditions should be met as much as possible: minimize triggers such as emergency stop , braking and other operating instructions, shorten the path length as much as possible, reduce energy consumption as much as possible, and improve the movement safety of the movable platform as much as possible.
  • the movement path satisfies at least one of the following conditions: the distance between the waypoint on the movement path and the target object is greater than the safety distance; the resource consumption of the movable platform from the initial waypoint of the movement path to the target waypoint is optimal, and the resources It includes at least one of the following: path length, energy or time; the smoothness of the moving path meets the maneuvering requirements of the movable platform.
  • the safety distance may be related to the size of the movable platform, the working radius of the movable platform, etc., so as to ensure the flight safety and operation effect of the movable platform.
  • the environment of the movable platform can be supplemented by the semantic information contained in the semantic map information, and plan the movement path based on the movement strategy corresponding to the semantic information.
  • the movable platform usually obtains its operating environment information through its own complex environment detection sensors to perform path planning, resulting in the problems of high cost and high energy consumption. In particular, it fills the technical gap of path planning for movable platforms in a relatively stable environment, and at least partially satisfies users' needs for low-cost, reusable path planning.
  • users can update the semantic map based on their own needs, so that the updated semantic map is more in line with the user's needs or the compatibility with the current environment of the mobile platform.
  • the above method may further include the following operations.
  • an initial semantic map of the mobile platform runtime environment is obtained.
  • the update information of the semantic map generated based on the user operation is obtained.
  • the initial semantic map is updated according to the semantic map update information, so as to obtain the semantic map of the operating environment of the mobile platform.
  • the initial semantic map may be a semantic map read from a storage space, a semantic map obtained from a network, or a semantic map input by a user.
  • This initial semantic map can be displayed in an interactive interface for editing.
  • User operations may be input through the control terminal.
  • the control terminal is provided with components such as buttons and levers, and the user can input semantic map update information by operating these components.
  • the control terminal may include a display screen, and the user may input semantic map update information through interactive components (such as virtual keys, joysticks, etc.) displayed on the display screen.
  • the user operation may also be determined and input based on gesture recognition, gesture recognition, somatosensory, or voice recognition.
  • the user can tilt the control terminal to control the position, movement direction, or other aspects of the cursor on the interactive interface.
  • the tilt of the control terminal can be detected by one or more inertial sensors, and corresponding commands (such as motion commands) are generated.
  • the user can use the touch screen to adjust the operating parameters of the load (such as spray parameters, mapping parameters, etc.), the attitude of the load (through the carrier), or other aspects of any object on the movable platform.
  • the object to which the user operates may be a control terminal communicatively connected to the movable platform.
  • the user inputs at least one of the following information on the control terminal: selection information, point coordinate input information, specified operation (such as edit, delete, add), object and parameter values of the specified operation (such as coordinate value, safety distance, semantic information) , obstacle avoidance strategies), etc.
  • the control terminal may be integrated, for example, the remote controller is provided with a processor, a memory, a display screen, and the like.
  • the control terminal may be split.
  • the remote control and other electronic devices may form a control terminal.
  • the remote control and a smart phone may be interconnected to form a control terminal.
  • an application APP
  • the APP may input operation instructions, set operation parameters, and the like.
  • the above method may further include the following operations: providing a user interaction interface, and displaying the initial semantic map on the user interaction interface.
  • acquiring the semantic map update information generated based on the user operation may include the following operations: acquiring the semantic map update information generated based on the user's operation on the user interaction interface.
  • FIG. 6 is a schematic diagram of a user interaction interface provided by an embodiment of the present application.
  • the user interaction interface may include an editing area and an effect displaying area.
  • the user can input semantic map update information.
  • the semantic map update information includes location, shape, and semantic information of the updated image region in the semantic map.
  • some semantic information may not have an obstacle avoidance strategy.
  • the obstacle avoidance strategy for buildings is detour, and the corresponding relationship can be globally universal. If the user adds an image area representing the building on the semantic map, it is not necessary to create a separate The obstacle avoidance strategy is set in the image area representing the building, but its obstacle avoidance strategy is automatically set to detour based on the existing corresponding relationship.
  • the position, shape and semantic information of the existing image area at least part of the information can be edited by the user, which effectively improves the convenience of the user's operation and can be better applied to more scenes.
  • the user can update each part of the information in the editing area, such as adding a corresponding relationship, editing the corresponding relationship, or deleting the corresponding relationship.
  • you can modify the pattern (such as modifying the color, filling pattern, etc.), modify the semantic information (such as modifying the wheat field to an orchard), and modify the obstacle avoidance strategy (such as modifying the passage to detour or pass above, etc.) .
  • the semantic map update information is stored in a configuration file and can be retrieved when used. In this way, the original semantic map will not be directly modified, so that the semantic map can be reused.
  • FIG. 7 is a schematic diagram of updating a semantic map according to an embodiment of the present application.
  • the image area representing the cornfield in FIG. 7 is enlarged, and the image area representing the cornfield may be determined based on the semantic map update information input by the user.
  • the semantic map enlarges the image area representing the cornfield in the original semantic map (or redraws the new image area representing the cornfield and covers the original image area representing the cornfield, or deletes the original image area representing the cornfield and redraws a representation The new image area of the cornfield), and establish the correspondence between the image area and the semantic information of the cornfield.
  • the image area characterizing the cornfield can also be determined by calling a configuration file. For example, after the last plant protection operation by the user or the drone, the image area of the cornfield as shown in Figure 7 is determined, and a configuration file is generated. Then in the next job, you can directly call the last configuration file to update the initial semantic map.
  • the semantic map update information further includes an obstacle avoidance strategy corresponding to the semantic information of the updated image area in the semantic map.
  • the user can input the semantic map update information to set the obstacle avoidance strategy corresponding to the updated semantic information of the image area.
  • an obstacle avoidance strategy can be further set.
  • new semantic information is added to the map: Reef. The reef does not have a corresponding obstacle avoidance strategy, and the user needs to be prompted to set it, or there is a corresponding obstacle avoidance strategy, but it is open to User makes changes.
  • the embodiment of the present application can also modify the obstacle avoidance strategy corresponding to the semantic information of the existing image regions in the semantic map.
  • the semantic map update information includes an obstacle avoidance strategy corresponding to the semantic information of the image region in the initial semantic map.
  • FIG. 8 is a schematic diagram of updating a semantic map according to another embodiment of the present application.
  • the initial semantic map includes image areas corresponding to water surface, no-fly zone, high-voltage line tower, wheat field, building, and cornfield, respectively.
  • the initial map also includes obstacle avoidance strategies corresponding to the above image areas: passing, detouring, detouring, passing, detouring, and passing above. If there is no need to spray the cornfield in this task, or as the corn in the cornfield continues to grow taller, it is no longer suitable for the obstacle avoidance strategy of passing above, then the user can adjust the obstacle avoidance strategy corresponding to the cornfield” "Passing above” is changed to "Bypass". This effectively improves the applicability of the planned movement path.
  • FIG. 9 is a schematic diagram of updating a semantic map according to another embodiment of the present application.
  • the initial semantic map includes image areas corresponding to water surface, no-fly zone, high-voltage line tower, wheat field, building and corn field respectively.
  • the user may replace the corn crops on the corn field with fruit trees in order to improve economic benefits, so that the image area originally representing the corn field is now changed to the image area representing the fruit forest.
  • the user can change the semantic information "cornfield" to "fruit forest” through the user interface of the APP without rebuilding the map.
  • FIG. 10A is a schematic diagram of updating a semantic map according to another embodiment of the present application.
  • the user can directly set an obstacle area in the semantic map as required, and the obstacle area is used to represent a virtual obstacle, so that the planned movement path bypasses the obstacle area.
  • the obstacle area is used to represent a virtual obstacle, so that the planned movement path bypasses the obstacle area.
  • an area has been manually sprayed with liquid medicine, and there is no need to repeat the operation; for another example, an area may be constructed or netted in the near future.
  • the user can set the obstacle area at the corresponding position in the semantic map through the user interface, so that the The planned path bypasses the obstacle area, which effectively improves the flexibility of operation.
  • the side detour strategy can be an obstacle avoidance strategy that is not suitable for passing through the geographic location corresponding to the image area, reducing the probability of the movable platform interfering, and reducing the occurrence of the movable platform in the process of moving according to the moving path.
  • the probability of undesired operations such as change of moving direction, emergency stop, braking, etc., helps to improve moving efficiency and helps reduce energy consumption.
  • the side detour strategy includes: when the size of the target object satisfies the preset condition, adopting the first side detour strategy to perform the side detour, and when the size of the target object does not meet the preset condition, adopting the second detour strategy
  • the side detour strategy performs a side detour. For example, when the size of the target object in the target image area is too large and a similar bow-shaped moving path is adopted, if the strategy of bypassing the obstacle sideways and then continuing the operation will result in too many moving paths being used for Going around obstacles will reduce work efficiency. For another example, when the size of the target object in the target image area is small and the obstacle can be quickly bypassed, a work strategy of bypassing the obstacle can be adopted.
  • the moving path is a bow-shaped path
  • the bow-shaped path includes a work path and a traverse path
  • the size of the target object is the size of the target object in a direction perpendicular to the work path.
  • the bow-shaped path may be a projection of the moving path on a two-dimensional horizontal plane, and in a three-dimensional space, the bow-shaped path may also include height information for each path point.
  • FIG. 10B is a schematic diagram of a movement path provided by an embodiment of the present application.
  • the obstacle avoidance strategy of the graphic area representing the building on the left side of the map is different from the obstacle avoidance strategy of the image area representing the building on the right side of the map.
  • the size of the graphic area representing the building (such as a factory) on the left side of the map is significantly larger than that on the right side of the map.
  • the size of the image area (such as a utility pole).
  • the obstacle avoidance strategy of switching to the adjacent operation path is adopted for the graphic area representing the building on the left side of the map, and the side detour is adopted for the graphic area representing the building on the left side of the map to continue the current operation path.
  • the size of the target object may refer to the maximum size of the target object, such as maximum width, maximum length, or maximum height.
  • a first side detour strategy includes moving to an adjacent work path.
  • the second side detour strategy includes detouring from the side to continue the current work path.
  • the first side detour strategy when the ratio between the size of the target object and the working path spacing is greater than the specified multiple, the first side detour strategy can be adopted, and when the ratio between the size of the target object and the working path spacing is smaller than the specified multiple, the second strategy is adopted.
  • Side detour strategy the specified multiple can be set or modified by the user.
  • the priority of the obstacle avoidance strategy of each path point in the above-mentioned planned moving path is lower than that of the obstacle avoidance strategy corresponding to the actual obstacle detected by the movable platform during the moving process according to the above-mentioned moving path.
  • the obstacle avoidance strategy corresponding to a certain waypoint in the moving path is to pass.
  • priority should be given to adopting a strategy that does not cause the movable platform to interact with the waypoint.
  • Table 1 exemplarily lists the correspondence between some semantic values and obstacle avoidance strategies in the scene where the movable platform is a UAV.
  • the obstacle avoidance strategy further includes safety distance information, where the safety distance information is used to indicate the minimum distance between the movable platform and the target object corresponding to the target image area.
  • image regions with different semantic information can each have different safety distances, so as to reduce the length of the movement path on the basis of ensuring movement safety.
  • a larger safety distance can be set for the image area representing the building in the semantic map, such as increasing the value of the safety distance corresponding to the semantic value.
  • the electromagnetic radiation generated by the electric wire may cause greater interference to the communication between the control terminal and the movable platform. Therefore, a larger image area can be set for the image area representing the electric wire in the semantic map. safe distance.
  • the safety distance is related to at least one of the following: the size of the movable platform, and the working radius of the movable platform.
  • the obstacle avoidance strategy contains the safety distance information
  • the obstacle avoidance strategy is related to the semantic information, so that the correspondence between the safety distance information and the semantic information can be easily determined.
  • the braking distance of the road robot at high speed is greater than the braking distance of the road robot at low speed.
  • the braking distance of the aerial robot The distance is greater than the braking distance of the road robot, etc. Therefore, the safety distance can be set based on the minimum obstacle avoidance distance of the movable platform, so as to improve the safety of the movable platform.
  • FIG. 11 is a schematic diagram of a safety distance provided by an embodiment of the present application.
  • the safety distance may be a distance for two scenarios, as shown by the two-way arrow line segment in the reference figure.
  • the safety distance shown in the left image of Figure 11 is for the graphical area where the obstacle avoidance strategy in the semantic map is detour.
  • the movable platform detours the area corresponding to a certain graphical area the distance between the movable platform and the area The distance between them needs to be greater than the safety distance.
  • the safety distance shown in the right figure of Figure 11 is for the detected obstacle in the process of moving the movable platform according to the planned moving path, and it is necessary to control the distance between the movable platform and the obstacle to be greater than the safety distance .
  • the concept of height information is also shown in Table 1, and the height information is exemplified below.
  • the semantic information corresponding to the graphic area indicated by the symbol 1115 is cornfield.
  • the height of cornfield is higher than that of wheatfield, for drones, it can move by passing through the top. Helps to reduce the length of the travel path by eliminating the need to detour from the side.
  • the above method may further include the following operation: acquiring the elevation information corresponding to the target image area.
  • planning the moving path of the movable platform to avoid the target object corresponding to the target image area including: according to the semantic information of the target image area corresponding to the movable platform
  • the platform's obstacle avoidance strategy and the elevation information corresponding to the target image area plan the moving path of the movable platform to avoid the target object corresponding to the target image area.
  • the elevation information may be read from a semantic map with elevation information.
  • the semantic map with elevation information can be obtained by fusing the elevation map and the semantic map.
  • the semantic map with elevation information may be generated by the user marking the elevation information by himself.
  • the semantic map with elevation information may be directly generated by a mapping device with an image sensor and a ranging sensor.
  • the elevation information can be a specific height value, or a height range, etc.
  • planning the moving path of the movable platform to avoid the target object corresponding to the target image area may include the following steps: operate.
  • the obstacle avoidance strategy includes passing above
  • plan the moving path of the movable platform to avoid the target object corresponding to the target image area plan the moving path of the movable platform to avoid the target object corresponding to the target image area .
  • FIG. 12 is a schematic diagram of a semantic map provided by another embodiment of the present application.
  • the semantic map not only includes a plurality of image regions with different semantic information, but also is marked with elevation information corresponding to each semantic.
  • the elevation information of the image area where the semantic information is the water surface (or road) is 0 meters
  • the elevation information of the no-fly zone is infinite ( ⁇ ) meters
  • the elevation information of the high-voltage line tower is less than 20 meters ( ⁇ 20 meters)
  • the height information of the wheat field is less than 20 meters ( ⁇ 20 meters).
  • the elevation information is 1 meter
  • the elevation information of the building is greater than 10 meters (>10 meters)
  • the elevation information of the cornfield is 2 to 3 meters. Based on the above information, more appropriate path planning can be performed for different movable platforms.
  • the drone can fly in the air at a height of more than 4 meters, and the obstacle avoidance strategy of passing above can be adopted for the cornfield.
  • on-road robots can drive through the area of high-voltage line towers on the ground, while drones need to bypass the high-voltage line towers.
  • the height value of the elevation information is relative to the ground, and may also be relative to the horizontal plane, which is not limited here.
  • the height value of the elevation information may be relative to a preset plane, such as the height value of the ground plane.
  • the movable platform may move based on a planned movement path.
  • obstacle avoidance needs to be performed based on the obstacle information detected in real time.
  • the complexity of the sensor adopted in this embodiment can be greatly reduced.
  • the technical solution of the present application can only use two-way radar, which can reduce hardware costs. At the same time, it also reduces the body weight, computing resource consumption and energy consumption.
  • the above method may further include the following operations: controlling the movable platform
  • the platform moves based on the moving path and the obstacle information detected by the movable platform through the sensors.
  • the mobile platform detects the obstacle information through the sensor, and can use the method of detecting obstacles in related technologies, such as detection based on image, radar (such as lidar or ultrasonic radar, etc.), ranging sensor, etc., which is not limited here. .
  • the most suitable movement strategy may be selected based on the type of movable platform.
  • the movable platform is an unmanned aerial vehicle.
  • the unmanned aerial vehicle will move from The first priority for passing over the obstacle is higher than the second priority for passing under the obstacle. This is because for drones, the flight height can be adjusted, and the probability of obstacles in low altitudes is greater than the probability of obstacles in high altitudes, so the safety probability of drones passing from above is greater than the safety probability of passing from below .
  • FIG. 13 is a schematic diagram of moving based on obstacle information detected by a sensor according to an embodiment of the present application.
  • the movable platform is an unmanned aerial vehicle as an example for illustration.
  • the UAV detected obstacle information during the process of circumventing the no-fly zone.
  • the UAV can deviate from the planned movement path to bypass obstacles.
  • controlling the movable platform to move based on the moving path and information of obstacles detected by the movable platform through the sensor includes: when the confidence of the obstacle detected by the sensor is greater than a preset threshold, controlling the movable platform Based on the moving path and the obstacle information detected by the mobile platform through the sensor, the confidence of the obstacle is related to the number of times the obstacle is repeatedly detected and the environmental information when the obstacle is detected.
  • the confidence of the obstacle is less than a certain threshold, it is determined that the information of the obstacle is unreliable and can be ignored. For example, in windy and rainy weather, information about obstacles such as leaves and raindrops may be detected, but the confidence of these obstacles is low. If the detection results in multiple adjacent detection cycles are quite different, the obstacle can be ignored. information. For example, if the UAV detects an obstacle at the same location multiple times or the UAV detects an obstacle continuously in a small area, the confidence of the obstacle information is high.
  • the above method further includes: updating the semantic map based on the obstacles detected by the movable platform. For example, if it is determined that the obstacle information existing in a certain image area in the semantic map satisfies a certain condition, it can be determined that the obstacle is a relatively stable obstacle, and the semantic map can be updated according to the obstacle information.
  • FIG. 14 is a schematic diagram of updating a semantic map based on obstacle information detected by a movable platform according to an embodiment of the present application.
  • an obstacle area can be set at the corresponding position on the semantic map.
  • the movable platform may also update the semantic map based on the detected obstacle information.
  • the initial semantic map may be directly modified, or an obstacle area for the semantic map may be added in the form of a configuration file.
  • whether to update the initial semantic map based on the obstacle area in the configuration file may also be determined based on the stability of the obstacle. For example, during the operation of the designated area or the process of returning home, the plant protection UAV detects the obstacle information at the same position for several consecutive times, or continuously exceeds the preset time threshold (such as 1 week, 1 month, 1 year) detected the obstacle information at the same position, the obstacle area that exists stably in the configuration file can be solidified in the initial semantic map. This enables automatic updating of the initial semantic map.
  • the obstacle area may be automatically updated by the movable platform based on preset rules, or may be set by the user. For example, before a user performs an operation, an obstacle area can be set in an area that does not require operation or needs to be avoided on the semantic map (such as an image area where there may be obstacles) to meet the diverse needs of the user.
  • planning the moving path of the movable platform to avoid the target object corresponding to the target image area includes: first, according to the three-dimensional position of the target image area Information and obstacle avoidance strategies establish objective functions. Then, the objective function is optimized to determine the movement path of the movable platform to avoid the target object.
  • optimizing the objective function to determine the moving path of the movable platform to avoid the target object may include: minimizing the objective function to determine the position parameters of the movable platform corresponding to the multiple target trajectory points, and the movable platform corresponding to the multiple target trajectory points.
  • the positional parameters of minimize the function value of the objective function.
  • the objective function may include at least one of the following: a collision cost function, a cost function representing kinematic and dynamic constraints, and a safety distance in an obstacle avoidance strategy that affects the collision cost function.
  • the objective function can also include a path length cost function, which is used to constrain the direction of travel (the location of the path point).
  • the objective function can also include a kinetic energy damage cost function, which is used to constrain the flight speed, etc.
  • a kinetic energy damage cost function which is used to constrain the flight speed
  • various parameters that can affect path planning can be set to corresponding cost functions, such as assistant cost functions, which can be used to constrain the direction of movement to constrain the resistance during movement, such as the energy of downwind (downstream) movement.
  • the energy consumption is less than the energy consumption of moving against the wind, such as the energy consumption of moving on an asphalt road is less than that of moving on a sandy road.
  • Fig. 15 is a schematic diagram showing that the smoothness of the moving path provided by the embodiment of the present application satisfies the maneuvering requirement of the movable platform. As shown in Figure 15, the moving path is smoother than the two-to-two connection between multiple points, which meets the maneuvering requirements of the movable platform.
  • multiple predicted trajectory points can be sampled from the predicted trajectory, and the objective function can be minimized by taking the position parameters of the UAV corresponding to the sampled multiple predicted trajectory points as the initial value .
  • FIG. 16 is a schematic flowchart of path planning provided by another embodiment of the present application.
  • the process of path planning can mainly include three parts: input condition preparation, algorithm planning, and execution. The specific content of each stage is introduced in turn.
  • the input conditions involved in this part are some parameters pre-set by the operator for the return-to-home task. Among them, at least some of the parameters do not need to be set by the user every time the user performs the task, such as the safety distance parameter, the initial path starting point and the target path point, etc.
  • the user can set the initial path starting point and the target path point of the moving path.
  • the return-to-home task is to safely return to the target point from the current position of the robot, so the return-to-home start point and return-to-home end point can be preset by the user.
  • the starting point of the return home is the current position of the robot, and the end point of the return home can be set through the default home point (home) point, or the user can click to set it through the APP, or input it in the form of a configuration file, which is not limited here.
  • the semantic map modification includes two ways: the user selects polygonal obstacles on the semantic map, or the user modifies the semantic value of the pixel point.
  • detour obstacle information can also be set by the user.
  • semantic map information annotates the semantic values of different objects, it is necessary to determine which image areas corresponding to the semantic values need to be detoured during planning.
  • graphics areas corresponding to semantic values such as fruit trees, buildings, and utility poles can be designated as graphics areas that need to be detoured, while graphics areas corresponding to farmland, road surfaces, and water surfaces do not need to be detoured.
  • the planning parameters include but are not limited to: the minimum safe distance of the robot from the obstacle, the robot motion limit parameters, the robot flying height, etc.
  • the extraction of the obstacle contour in the semantic map is based on the consideration that the obstacle information in the semantic map is set through a pixel point, and a large number of obstacle pixel points need to be aggregated into a polygonal outline in order to improve the subsequent calculations. It should be noted that this operation is not a necessary operation step, and it can also be planned directly on the pixel points, but this planning method is relatively slow (it takes a lot of time to query the semantic value of the pixel point multiple times). For example, refer to Figure 14 for the outlines of the graphic areas.
  • the embodiments of the present application also support the user to directly select polygonal obstacles on the semantic map.
  • the box-selected polygon information may not be stored in the semantic map, such as read in the form of a configuration file.
  • the graphic areas of the polygonal obstacles formed in this operation are fused with the contours of the obstacles extracted in the previous operation, so that all the graphic areas of the obstacles are represented by the polygonal graphic areas on the semantic map.
  • the moving path can have the following characteristics: On the one hand, any part of the path satisfies the minimum distance (safety distance) from the movable platform to the obstacle. On the one hand, the "cost" from the initial waypoint to the target waypoint is the smallest, wherein the cost can be evaluated by different indicators, such as the shortest distance and the smallest energy cost. On the one hand, the moving path is smooth and meets the maneuvering requirements of movable platforms (such as drones, etc.).
  • the path needs to be properly formatted to meet the requirements of the later execution, and then the path is output.
  • the movable platform may execute the movement path based on the return-to-home movement path generated in the previous operation.
  • an effect similar to a geo-fence can also be achieved based on the semantic map, which facilitates setting operation specifications for the operator of the movable platform, and reduces the risk of the movable platform moving to a restricted area.
  • the following operations are further included.
  • lever volume For example, in a drone flying competition, a closed no-fly zone can be set up through a semantic map, or a no-fly zone can be set up for a specific area in the competition venue to prevent improper drone operation from causing damage to spectators or competitors passing the rules. way of playing the game, etc.
  • FIG. 17 is a schematic diagram of a non-response control rod amount provided by an embodiment of the present application.
  • the dotted line is the movement track of the movable platform
  • the peripheral grid area is set as the semantic information is a building
  • a no-fly zone is also set inside. If the user's lever amount would cause the movable platform to enter a graphics area corresponding to a building or a graphics area corresponding to a no-fly zone, the movable platform may determine, based on the semantic map, not to respond to the lever amount.
  • the following takes the drone and its control terminal as an example to illustrate the execution subject of each of the above operations.
  • the UAV and its control terminal can transmit at least part of the following information to each other.
  • a semantic map of the operating environment of the mobile platform can be obtained by the UAV and/or its control terminal.
  • the semantic information of the target image area in the semantic map can be determined by the UAV and/or its control terminal.
  • the moving path of the movable platform to avoid the target object corresponding to the target image area can be planned by the UAV and/or its control terminal.
  • the semantic map update information may be received by the control terminal.
  • the user interface and various information related to path planning can be displayed by the control terminal.
  • the obstacle information during the flight can be detected by the drone through the sensor to move.
  • the semantic map can be updated by the drone and/or its control terminal.
  • each of the above operations is only an exemplary description, and should not be construed as a limitation of the present application. It may be independently completed by one of the movable platform, control terminal, PTZ or load, or several of them may cooperate with each other. Finish.
  • a human-computer interaction module such as a display for displaying a human-computer interaction interface, etc.
  • the user can directly display the interactive interface on the movable platform. Get user actions to get map update information, etc.
  • independent completion includes actively or passively, directly or indirectly obtaining corresponding data from other devices to perform corresponding operations
  • the path planning method provided by the embodiments of the present application uses the environmental information provided by the semantic map as at least part of the basis for path planning, which enriches the sources of environmental information and reduces the dependence on related technologies to perceive environmental information through complex sensors.
  • the semantic map can be reused, and there is no need to perceive the environment information through complex sensors to build the map in real time every time the path planning is performed.
  • the environmental information included in the semantic map can be edited, the user can edit the environmental information according to the actual scene, which improves the flexibility of its application.
  • the semantic map since the semantic map is pre-made, the calculation amount of the environment detection during the operation of the mobile platform is reduced, and the resource consumption is effectively reduced.
  • FIG. 18 is a schematic structural diagram of a path planning apparatus provided by an embodiment of the present application.
  • the path planning apparatus 1800 may include one or more processors 1810, and the one or more processors 1810 may be integrated in one processing unit, or may be separately arranged in multiple processing units.
  • the computer-readable storage medium 1820 is used to store one or more computer programs 1821.
  • the above path planning method is implemented, for example, obtaining a first user instruction; in response to the first user instruction, from Determining at least one base point within the auxiliary field of view; and determining a desired field of view based on the at least one base point to obtain an image conforming to the desired field of view.
  • the path planning apparatus 1800 may be set in one execution body or respectively set in multiple execution bodies.
  • the path planning device 1800 can be set in the land robot.
  • a display screen is arranged on the body to facilitate interaction with the user.
  • at least part of the path planning apparatus 1800 can be set in the control terminal, such as the relevant functions of accepting user operations are set in the control terminal.
  • At least a part of the path planning apparatus 1800 may be set in a movable platform, such as at least one of an information transmission function, an environmental information sensing function, and a linkage control function.
  • at least a portion of the path planning apparatus 1800 may be placed under load or the like.
  • the processing unit may comprise a Field-Programmable Gate Array (FPGA) or one or more ARM processors.
  • the processing unit may be connected to non-volatile computer readable storage medium 1820.
  • the non-volatile computer-readable storage medium 1820 may store logic, code, and/or computer instructions executed by the processing unit for performing one or more steps.
  • the non-volatile computer-readable storage medium 1820 may include one or more storage units (removable media or external memory such as SD card or RAM).
  • the data sensed by the sensor may be transferred and stored directly into a storage unit of the non-volatile computer-readable storage medium 1820 .
  • the storage units of the non-volatile computer-readable storage medium 1820 may store logic, code, and/or computer instructions executed by the processing unit to perform various embodiments of the various methods described herein.
  • a processing unit may be configured to execute instructions to cause one or more processors of the processing unit to perform the tracing functions described above.
  • the storage unit may store sensing module sensing data, the data sensing being processed by the processing unit.
  • the storage unit of the non-volatile computer-readable storage medium 1820 may store processing results generated by the processing unit.
  • the processing unit may be connected to the control module for controlling the state of the movable platform.
  • the control module may be used to control the power mechanism of the movable platform to adjust the spatial orientation, velocity and/or acceleration of the movable platform relative to six degrees of freedom.
  • the control module may control one or more of the carrier, load or sensing module.
  • the processing unit may also be connected to the communication module for transmitting and/or receiving data with one or more peripheral devices (eg, terminals, display devices, or other remote control devices).
  • peripheral devices eg, terminals, display devices, or other remote control devices.
  • Any suitable communication method may be utilized here, such as wired communication or wireless communication.
  • the communication module may utilize one or more local area networks, wide area networks, infrared, radio, Wi-Fi, peer-to-peer (P2P) networks, telecommunication networks, cloud networks, and the like.
  • P2P peer-to-peer
  • a relay station such as a signal tower, a satellite, or a mobile base station, can be used.
  • the above-mentioned various components may be compatible with each other.
  • one or more components are located on a movable platform, carrier, payload, terminal, sensing system, or additional external device in communication with each of the foregoing.
  • one or more of the processing unit and/or non-transitory computer-readable medium may be located in different locations, such as on a removable platform, carrier, payload, terminal, sensing system, or Additional external devices that communicate with the foregoing devices and various combinations of the foregoing.
  • control terminal adapted to the movable platform may include an input module, a processing unit, a memory, a display module, and a communication module, all of which are connected by a bus or similar network.
  • the input module includes one or more input mechanisms to obtain input generated by the user by manipulating the input module.
  • Input mechanisms include one or more joysticks, switches, knobs, slide switches, buttons, dials, touchscreens, keypads, keyboards, mice, voice controls, gesture controls, inertial modules, and the like.
  • the input module may be used to obtain user input for controlling the movable platform, carrier, load, or any aspect of the components therein. Any aspect includes attitude, position, orientation, flight, tracking, etc.
  • the input mechanism may be that the user manually sets one or more positions, each position corresponding to a preset input, to control the movable platform.
  • the input mechanism may be operated by a user to input control commands to control the movement of the movable platform.
  • a user can use a knob, switch, or similar input mechanism to input a motion mode of the movable platform, such as auto-flying, auto-pilot, or moving according to a preset motion path.
  • the user can control the position, attitude, orientation, or other aspects of the movable platform by tilting the control terminal in a certain way.
  • the tilt of the control terminal can be detected by one or more inertial sensors, and corresponding motion commands can be generated.
  • the user may utilize the input mechanisms described above to adjust operational parameters of the payload (eg, zoom), the attitude of the payload (via the carrier), or other aspects of any object on the movable platform.
  • the input mechanism may be operated by the user to input the aforementioned descriptive object information.
  • the user may select an appropriate tracking mode, such as a manual tracking mode or an automatic tracking mode, using a knob, switch, or similar input mechanism.
  • the user may also utilize this input mechanism to select a specific target to be tracked, target type information to execute, or other similar information.
  • the input module may be executed by more than one device.
  • the input module can be implemented by a standard remote controller with a joystick.
  • a standard remote controller with a joystick connects to a mobile device (eg, a smartphone) running a suitable application (“APP”) to generate control commands for the movable platform.
  • APPs can be used to obtain user input.
  • the processing unit may be connected to the memory.
  • Memory includes volatile or non-volatile storage media for storing data, and/or logic, code, and/or program instructions executable by a processing unit for performing one or more rules or functions.
  • the memory may include one or more storage units (removable media or external memory such as SD card or RAM).
  • the data input to the module may be directly transferred and stored in a storage unit of the memory.
  • the storage units of the memory may store logic, code and/or computer instructions executed by the processing unit to perform various embodiments of the various methods described herein.
  • the processing unit may be configured to execute instructions to cause one or more processors of the processing unit to process and display sensory data (eg, images) obtained from the movable platform, control commands generated based on user input, including motion commands and objects information, and cause the communication module to transmit and/or receive data, etc.
  • the storage unit may store sensed data or other data received from an external device such as a removable platform.
  • the storage unit of the memory may store the processing result generated by the processing unit.
  • the display module may be used to display the position, translation velocity, translation acceleration, orientation, angular velocity, angular acceleration, or a combination thereof of the movable platform 10, the carrier 13 and/or the working equipment 14 as shown in FIG. 2 . etc. information.
  • the display module can be used to obtain information sent by the movable platform and/or payload, such as sensory data (images recorded by cameras or other image capture devices), described tracking data, control feedback data, and the like.
  • the display module may be executed by the same device as the input module. In other embodiments, the display module and the input module may be executed by different devices.
  • the communication module may be used to transmit and/or receive data from one or more remote devices (eg, removable platforms, carriers, base stations, etc.).
  • the communication module can transmit control signals (such as motion signals, target information, and tracking control commands) to peripheral systems or devices, such as the movable platform 10 , the carrier 13 and/or the surveying and mapping device in FIG. 2 .
  • the communication module may include a transmitter and a receiver for receiving data from and transmitting data to the remote device, respectively.
  • the communication module may include a transceiver that combines the functions of a transmitter and a receiver.
  • the transmitter and receiver and the processing unit may communicate with each other. Communication may utilize any suitable means of communication, such as wired or wireless communication.
  • Images captured by the movable platform during motion can be transmitted from the movable platform or imaging device back to a control terminal or other suitable device for display, playback, storage, editing, or other purposes. Such transmission may occur in real-time or near real-time as the imaging device captures the imagery. Optionally, there may be a delay between the capture and transmission of the imagery.
  • the imagery may be stored in the removable platform's memory without being transferred anywhere else. The user can view these images in real time and, if necessary, adjust target information or other aspects of the movable platform or its components. Adjusted object information may be provided to the movable platform, and the iterative process may continue until the desired image is obtained.
  • the imagery may be transmitted to a remote server from the removable platform, the imagery device, and/or the control terminal. For example, images can be shared on some social networking platforms, such as WeChat Moments or Weibo.
  • determining the semantic information of the target image region in the semantic map may include the following operations.
  • the target image area is determined according to the corresponding position information of the initial waypoint of the movable platform and the target waypoint in the semantic map and the semantic map.
  • the semantic information of the target image area is determined.
  • the initial waypoint of the movable platform is the start point of the return home
  • the target waypoint of the movable platform is the end point of the return home
  • determining the semantic information of the target image area in the semantic map according to the semantic map includes: determining the target image area according to the corresponding position information of the movable platform in the semantic map and the semantic map; determining the target image area according to the target image area; Semantic information of the target image region.
  • the above method may further include: acquiring an initial semantic map of the mobile platform operating environment; acquiring semantic map update information generated based on user operations; updating according to the semantic map The information updates the initial semantic map to obtain the semantic map of the operating environment of the mobile platform.
  • the above method further includes: providing a user interaction interface, and displaying the initial semantic map on the user interaction interface.
  • acquiring the semantic map update information generated based on the user operation includes: acquiring the semantic map update information generated based on the user's operation on the user interaction interface.
  • the semantic map update information includes location, shape, and semantic information of the updated image region in the semantic map.
  • the semantic map update information further includes an obstacle avoidance strategy corresponding to the semantic information of the updated image area in the semantic map.
  • the semantic map update information includes an obstacle avoidance strategy corresponding to the semantic information of the image region in the initial semantic map.
  • the obstacle avoidance strategy includes at least one of a side detour strategy, an upper pass strategy, or a downward pass strategy.
  • the side detour strategy includes: when the size of the target object satisfies the preset condition, adopting the first side detour strategy to perform the side detour, and when the size of the target object does not meet the preset condition, adopting the second detour strategy The side detour strategy performs a side detour.
  • the moving path is a bow-shaped path
  • the bow-shaped path includes a work path and a traverse path
  • the size of the target object is the size of the target object in a direction perpendicular to the work path.
  • the moving path is a bow-shaped path
  • the bow-shaped path includes a work path and a traverse path
  • the size of the target object is the size of the target object in a direction perpendicular to the work path.
  • whether the size of the target object satisfies a preset condition is determined by comparing the size of the target object with the working path distance of the movable platform.
  • the first side detour strategy includes moving to an adjacent work path.
  • the second side detour strategy includes detouring from the side to continue the current work path.
  • the operation status of the movable platform is set to prohibit operation.
  • the obstacle avoidance strategy further includes safety distance information, where the safety distance information is used to indicate the minimum distance between the movable platform and the target object corresponding to the target image area.
  • the safety distance is related to at least one of: the size of the movable platform, the working radius of the movable platform.
  • the elevation information corresponding to the target image area is acquired.
  • planning the moving path of the movable platform to avoid the target object corresponding to the target image area including: according to the semantic information of the target image area corresponding to the movable platform
  • the platform's obstacle avoidance strategy and the elevation information corresponding to the target image area are used to plan the moving path of the movable platform to avoid the target object corresponding to the target image area.
  • planning the moving path of the movable platform to avoid the target object corresponding to the target image area including:
  • the obstacle avoidance strategy includes passing above, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area and the elevation information corresponding to the target image area, plan the moving path of the movable platform to avoid the target object corresponding to the target image area .
  • the method further includes: controlling the movable platform The platform moves based on the moving path and the obstacle information detected by the movable platform through the sensor.
  • the movable platform is an unmanned aerial vehicle, and in the process of controlling the movable platform to move based on the moving path and the obstacle information detected by the movable platform through the sensor, for the obstacles detected by the unmanned aerial vehicle,
  • the first priority for the drone to pass above the obstacle is higher than the second priority for the drone to pass below the obstacle.
  • the semantic map is updated based on obstacles detected by the movable platform.
  • controlling the movable platform to move based on the moving path and information of obstacles detected by the movable platform through the sensor includes: when the confidence of the obstacle detected by the sensor is greater than a preset threshold, controlling the movable platform Based on the moving path and the obstacle information detected by the mobile platform through the sensor, the confidence of the obstacle is related to the number of times the obstacle is repeatedly detected and the environmental information when the obstacle is detected.
  • the contours of regions of the semantic map are extracted to generate movement paths based at least on the contours of the target image region.
  • the movement path satisfies at least one of the following conditions: the distance between the waypoint on the movement path and the target object is greater than the safety distance; the resource consumption of the movable platform moving from the initial waypoint of the movement path to the target waypoint Optimally, the resources include at least one of the following: path length, energy or time; and the smoothness of the moving path meets the maneuvering requirements of the movable platform.
  • planning the moving path of the movable platform to avoid the target object corresponding to the target image area includes: according to the three-dimensional position information of the target image area and The obstacle avoidance strategy establishes the objective function; the objective function is optimized to determine the moving path of the movable platform to avoid the target object.
  • the method further includes: receiving a generated image generated based on a user operation.
  • the joystick amount of if the joystick amount is determined to indicate that the movable platform enters the target image area, the joystick amount is not responded to.
  • Another aspect of the present application also provides a path planning system for planning a moving path, wherein the system includes: a control terminal and a movable platform that are communicatively connected to each other, wherein: the control terminal and/or the movable platform include the above Path planning device.
  • the movable platform may specifically be an agricultural drone or an agricultural unmanned vehicle.

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

A path planning method, a path planning apparatus, a path planning system, and a medium, used to plan a movement path for a mobile platform, the method comprising: acquiring a semantic map of an operating environment of a mobile platform, semantic information of each image region in the semantic map having a correspondence relationship with obstacle avoidance strategies of the mobile platform; on the basis of the semantic map, determining semantic information of a target image region in the semantic map; and on the basis of the obstacle avoidance strategy of the mobile platform corresponding to the semantic information of the target image region, planning a movement path for the mobile platform to avoid a target object corresponding to the target image region.

Description

路径规划方法、路径规划装置、路径规划系统和介质Path planning method, path planning device, path planning system and medium 技术领域technical field
本申请涉及机器人技术领域,尤其涉及一种路径规划方法、路径规划装置、路径规划系统和介质。The present application relates to the field of robotics, and in particular, to a path planning method, a path planning device, a path planning system and a medium.
背景技术Background technique
在机器人领域,很多典型的应用场景需要进行路径规划的操作。例如无人机、运输机器人等在封闭环境或开放环境内的路径规划。In the field of robotics, many typical application scenarios require path planning operations. For example, path planning of drones, transport robots, etc. in closed or open environments.
然而,相关技术在进行路径规划时采用的避障策略单一,并没有针对不同类型的障碍物设计相应的避障策略,难以在复杂场景中实现更为合理、高效的路径规划。However, the related art adopts a single obstacle avoidance strategy in path planning, and does not design corresponding obstacle avoidance strategies for different types of obstacles, and it is difficult to achieve more reasonable and efficient path planning in complex scenarios.
发明内容SUMMARY OF THE INVENTION
有鉴于此,本申请实施例提供一种路径规划方法、路径规划装置、路径规划系统和介质,以实现更为合理、高效的路径规划。In view of this, the embodiments of the present application provide a path planning method, a path planning device, a path planning system, and a medium, so as to realize more reasonable and efficient path planning.
第一方面,本申请实施例提供了一种路径规划方法,用于规划可移动平台的移动路径,该方法包括:首先,获取可移动平台运行环境的语义地图,语义地图中各个图像区域的语义信息与可移动平台的避障策略具有对应关系,然后,根据语义地图,确定语义地图中目标图像区域的语义信息。接着,根据目标图像区域的语义信息对应的可移动平台的避障策略,规划可移动平台避开目标图像区域对应的目标对象的移动路径。In a first aspect, an embodiment of the present application provides a path planning method for planning a moving path of a movable platform. The method includes: first, acquiring a semantic map of the operating environment of the movable platform, and the semantics of each image area in the semantic map The information has a corresponding relationship with the obstacle avoidance strategy of the movable platform, and then, according to the semantic map, the semantic information of the target image area in the semantic map is determined. Next, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, a moving path for the movable platform to avoid the target object corresponding to the target image area is planned.
第二方面,本申请实施例提供了一种路径规划装置,用于规划可移动平台的移动路径,该装置包括:一个或多个处理器;以及计算机可读存储介质,用于存储一个或多个计算机程序,计算机程序在被处理器执行时,实现:获取可移动平台运行环境的语义地图,语义地图中各个图像区域的语义信息与可移动平台的避障策略具有对应关系;根据语义地图,确定语义地图中目标图像区域的语义信息;以及根据目标图像区域的语义信息对应的可移动平台的避障策略,规划可移动平台避开目标图像区域对应的目标对象的移动路径。In a second aspect, embodiments of the present application provide a path planning apparatus for planning a moving path of a movable platform, the apparatus comprising: one or more processors; and a computer-readable storage medium for storing one or more processors A computer program, when the computer program is executed by the processor, realizes: obtains the semantic map of the operating environment of the mobile platform, and the semantic information of each image area in the semantic map has a corresponding relationship with the obstacle avoidance strategy of the mobile platform; according to the semantic map, Determine the semantic information of the target image area in the semantic map; and plan the moving path of the movable platform to avoid the target object corresponding to the target image area according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area.
第三方面,本申请实施例提供了一种路径规划系统,用于规划移动路径,该系统包括:相互通信连接的控制终端和可移动平台,其中,控制终端和/或 可移动平台包括如上的路径规划装置。In a third aspect, an embodiment of the present application provides a path planning system for planning a moving path, the system includes: a control terminal and a movable platform that are communicatively connected to each other, wherein the control terminal and/or the movable platform include the above Path planning device.
第四方面,本申请实施例提供了一种计算机可读存储介质,其存储有可执行指令,可执行指令在由一个或多个处理器执行时,可以使一个或多个处理器执行如上的方法。In a fourth aspect, embodiments of the present application provide a computer-readable storage medium, which stores executable instructions, and when the executable instructions are executed by one or more processors, can cause one or more processors to execute the above method.
在本实施例中,语义地图中各个图像区域的语义信息与可移动平台的避障策略之间具有对应关系,使得可移动平台可以基于各图像区域对应的避障策略进行路径规划,可以在复杂场景中实现更为合理、高效的路径规划。In this embodiment, there is a correspondence between the semantic information of each image area in the semantic map and the obstacle avoidance strategy of the movable platform, so that the movable platform can perform path planning based on the obstacle avoidance strategy corresponding to each image area. Realize more reasonable and efficient path planning in the scene.
应当明白,本申请的不同方面可以被单独地、共同地或彼此结合地理解。本文所描述的本申请的各个方面可以适用于下文阐述的任何特定应用或者适用于任何其他类型的可移动平台。本文对诸如无人飞行器等飞行器的任何描述可适用于和用于任何可移动平台,诸如任何载具。另外,本文在空中运动(例如,飞行)的情景下公开的系统、设备和方法还可以适用于其他类型运动的情景下,诸如在地面上或在水上的移动、水下运动或者在太空中的运动。It should be understood that different aspects of the present application may be understood individually, collectively or in combination with each other. The various aspects of the application described herein may be applicable to any particular application set forth below or to any other type of mobile platform. Any description herein of an aircraft, such as an unmanned aerial vehicle, is applicable to and used with any movable platform, such as any vehicle. Additionally, the systems, devices, and methods disclosed herein in the context of aerial motion (eg, flight) may also be applicable in the context of other types of motion, such as movement on the ground or on water, underwater motion, or in space sports.
本申请的附加方面的优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本申请的实践了解到。Advantages of additional aspects of the present application will be set forth in part in the following description, in part will be apparent from the following description, or learned by practice of the present application.
附图说明Description of drawings
通过参照附图的以下详细描述,本申请实施例的上述和其他目的、特征和优点将变得更容易理解。在附图中,将以示例以及非限制性的方式对本申请的多个实施例进行说明,其中:The above and other objects, features and advantages of embodiments of the present application will become more readily understood from the following detailed description with reference to the accompanying drawings. In the accompanying drawings, various embodiments of the present application will be illustrated by way of example and not limitation, wherein:
图1为本申请实施例提供的路径规划方法、路径规划装置、路径规划系统和介质的应用场景;1 is an application scenario of a path planning method, a path planning device, a path planning system, and a medium provided by an embodiment of the present application;
图2为本申请另一实施例提供的路径规划方法、路径规划装置、路径规划系统和介质的应用场景;2 is an application scenario of a path planning method, a path planning device, a path planning system, and a medium provided by another embodiment of the present application;
图3为本申请实施例提供的路径规划方法的流程示意图;3 is a schematic flowchart of a path planning method provided by an embodiment of the present application;
图4为本申请实施例提供的语义地图的示意图;4 is a schematic diagram of a semantic map provided by an embodiment of the present application;
图5为本申请实施例提供的返航起点和返航终点的示意图;5 is a schematic diagram of a return origin and a return destination provided by an embodiment of the present application;
图6为本申请实施例提供的用户交互界面的示意图;6 is a schematic diagram of a user interaction interface provided by an embodiment of the present application;
图7为本申请实施例提供的更新语义地图的示意图;7 is a schematic diagram of updating a semantic map provided by an embodiment of the present application;
图8为本申请另一实施例提供的更新语义地图的示意图;8 is a schematic diagram of updating a semantic map according to another embodiment of the present application;
图9为本申请另一实施例提供的更新语义地图的示意图;9 is a schematic diagram of updating a semantic map according to another embodiment of the present application;
图10A为本申请另一实施例提供的更新语义地图的示意图;10A is a schematic diagram of updating a semantic map according to another embodiment of the present application;
图10B为本申请实施例提供的移动路径的示意图;FIG. 10B is a schematic diagram of a movement path provided by an embodiment of the present application;
图11为本申请实施例提供的安全距离的示意图;11 is a schematic diagram of a safety distance provided by an embodiment of the present application;
图12为本申请另一实施例提供的语义地图的示意图;12 is a schematic diagram of a semantic map provided by another embodiment of the present application;
图13为本申请实施例提供的通过传感器检测到的障碍物信息进行移动的示意图;13 is a schematic diagram of moving through obstacle information detected by a sensor provided by an embodiment of the present application;
图14为本申请实施例提供的基于可移动平台检测到的障碍物信息更新语义地图的示意图;14 is a schematic diagram of updating a semantic map based on obstacle information detected by a movable platform according to an embodiment of the present application;
图15为本申请实施例提供的移动路径的平滑度满足可移动平台的机动要求的示意图;FIG. 15 is a schematic diagram illustrating that the smoothness of the movement path provided by the embodiment of the application meets the maneuvering requirements of the movable platform;
图16为本申请另一实施例提供的路径规划的流程示意图;16 is a schematic flowchart of path planning provided by another embodiment of the present application;
图17为本申请实施例提供的不响应控制杆量的示意图;17 is a schematic diagram of a non-response control rod amount provided by an embodiment of the present application;
图18为本申请实施例提供的路径规划装置的结构示意图。FIG. 18 is a schematic structural diagram of a path planning apparatus provided by an embodiment of the present application.
具体实施方式Detailed ways
下面详细描述本申请的实施例,实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本申请,而不能理解为对本申请的限制。Embodiments of the present application are described in detail below, examples of which are illustrated in the accompanying drawings, wherein the same 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 exemplary, and are intended to be used to explain the present application, but should not be construed as a limitation to the present application.
为了便于理解本申请的技术方案,以下结合图1~图20进行详细说明。In order to facilitate the understanding of the technical solutions of the present application, detailed description is given below with reference to FIGS. 1 to 20 .
图1为本申请实施例提供的路径规划方法、路径规划装置、路径规划系统和介质的应用场景。FIG. 1 is an application scenario of a path planning method, a path planning device, a path planning system, and a medium provided by an embodiment of the present application.
如图1所示,本申请的实施例是基于语义地图的路径规划方式,其填补了稳定环境下机器人路径规划的技术空白,提供了一种廉价可复用的路径规划方式。为了便于理解本申请的实施例,对语义地图进行示例性说明。As shown in FIG. 1 , the embodiment of the present application is a path planning method based on a semantic map, which fills the technical gap of robot path planning in a stable environment, and provides an inexpensive and reusable path planning method. In order to facilitate understanding of the embodiments of the present application, a semantic map is exemplarily described.
如图1所示,语义地图可以是一种像素图片(可以是tif/tfw格式),图片中每个像素对应一个真实世界的坐标位置,同时该像素存储了一个表示与该位置对应的语义信息,标注了位置对应的物体类型。为了便于使用该语义地图,可以将多个具有相同语义且相邻的像素共同组成一个图像区域。每个图 像区域具有对应的语义信息。其中,每个图像区域可以采用不同的颜色、填充图样等进行区别表示。例如,绿色像素点对应的都是农田的语义,表示这些像素点对应的实际位置是“农田”这种真实的物体。又例如,紫色像素点对应的都是“树木”这种物体。又例如,如图1所示,语义地图1中具有原点填充图样1111的图像区域的语义信息是麦田。具有纯白色填充图样1112的图像区域的语义信息是河流。具有横线填充图样1113的图像区域的语义信息是禁飞区。具有网格填充图样1114的图像区域的语义信息是建筑。具有斜线填充图样1115的图像区域的语义信息是玉米地。具有竖线填充图样1116的图像区域的语义信息是高压线塔。As shown in Figure 1, the semantic map can be a pixel picture (it can be in tif/tfw format), each pixel in the picture corresponds to a coordinate position in the real world, and the pixel stores a semantic information corresponding to the position , marking the object type corresponding to the position. In order to facilitate the use of the semantic map, a plurality of adjacent pixels with the same semantics can be collectively formed into an image area. Each image region has corresponding semantic information. Wherein, each image area can be represented by different colors, filling patterns, etc. For example, the green pixels correspond to the semantics of farmland, indicating that the actual position corresponding to these pixels is a real object such as "farmland". For another example, the purple pixels correspond to objects like "trees". For another example, as shown in FIG. 1 , the semantic information of the image area with the origin filling pattern 1111 in the semantic map 1 is a wheat field. The semantic information for the image area with the pure white fill pattern 1112 is a river. The semantic information of the image area with the horizontal line fill pattern 1113 is the no-fly zone. The semantic information of the image area with grid fill pattern 1114 is architecture. The semantic information for the image region with the diagonal hatch pattern 1115 is cornfield. The semantic information of the image area with the vertical line fill pattern 1116 is the high voltage line tower.
需要说明的是,以上语义划分的颗粒度是可调整的。例如,可以根据需求将颗粒度调大,如可以将麦田和玉米地划分为同一类:农作物;将高压线塔合并在建筑中。当然,可以根据需求将颗粒度调小,如建筑可以划分为高层建筑、矮层建筑等。It should be noted that the granularity of the above semantic division is adjustable. For example, the granularity can be increased according to the needs, such as the wheat field and the corn field can be divided into the same category: crops; the high-voltage line tower can be incorporated into the building. Of course, the granularity can be reduced according to requirements, for example, buildings can be divided into high-rise buildings and low-rise buildings.
语义地图的获取可以包含多种方式,不限定语义地图的来源。例如,语义地图可来自于航拍建图识别、用户手动划定、第三方下载等。The acquisition of the semantic map can include various methods, and the source of the semantic map is not limited. For example, semantic maps can come from aerial mapping recognition, manual delineation by users, third-party downloads, and the like.
现有的可移动平台离不开复杂的传感器,如需要基于激光雷达、超声波雷达和图像传感器等实时建图以实现避障。但是复杂的传感器必然带来硬件成本的增加。此外,对于小型机器人(如小型无人机)而言,复杂的传感器会增加机器人的重量,并且挤占小型机器人内部用于设置能量存储介质、作业物品等的空间。以无人机植保场景为例,相关技术中是基于复杂的硬件传感器实时检测障碍物实现规划路径的,其一大应用基础就是每个机器人都配置了复杂的环境探测传感器。一方面,复杂的传感器必然带来硬件成本的提升。另一方面,对于环境信息较为固定,机器人携带的传感器有限的场景,当前的路径规划方案难以适应。Existing mobile platforms are inseparable from complex sensors, such as real-time mapping based on lidar, ultrasonic radar and image sensors to achieve obstacle avoidance. But complex sensors will inevitably bring about an increase in hardware costs. In addition, for small robots (such as small drones), complex sensors increase the weight of the robot and crowd out the space inside the small robot for setting energy storage media, work items, etc. Taking the UAV plant protection scene as an example, the related technology is based on complex hardware sensors to detect obstacles in real time to realize the planned path. One of the application foundations is that each robot is equipped with complex environment detection sensors. On the one hand, complex sensors will inevitably bring about an increase in hardware costs. On the other hand, for scenarios where the environmental information is relatively fixed and the sensors carried by the robot are limited, the current path planning scheme is difficult to adapt.
因此,对于比较稳定的运行场景,相对于实时探测得到的语义地图,采用预先加载的语义地图可以降低可移动平台的硬件成本,减少由于实时建图耗费的计算资源。语义地图作为一种描述环境的方式,是一种配置文件,可以供多个机器人平台同时使用。由于机器人加载的地图相同,因此可以保证不同机器人在相同的条件下做出相同的规划结果。Therefore, for a relatively stable operation scenario, compared with the semantic map obtained by real-time detection, using the pre-loaded semantic map can reduce the hardware cost of the mobile platform and reduce the computing resources consumed by real-time mapping. As a way of describing the environment, a semantic map is a configuration file that can be used by multiple robotics platforms simultaneously. Since the maps loaded by the robots are the same, different robots can be guaranteed to make the same planning results under the same conditions.
需要说明的是,上述无人机植保场景仅为示例性说明,不能理解为对本 申请的限定。其中,无人机可以为消费级无人机、农业无人机以及行业应用无人机等。机器人可以是路上机器人、室内机器人、水上机器人、水中机器人、水底机器人、空中机器人等,在此不做限定。It should be noted that the above-mentioned UAV plant protection scenarios are only exemplary descriptions, and should not be construed as limitations on this application. Among them, UAVs can be consumer UAVs, agricultural UAVs, and industrial application UAVs. The robot may be a road robot, an indoor robot, an aquatic robot, an underwater robot, an underwater robot, an aerial robot, etc., which is not limited herein.
如图1所示,可以将语义地图作为路径规划的输入,基于语义地图中各图像区域的语义信息确定对应图像区域的避障策略,进而基于避障策略进行路径规划。如图1的语义地图中,针对原点填充图样1111和纯白色填充图样1112的图像区域的避障策略是通行,针对横线填充图样1113和网格填充图样1114的图像区域的避障策略是绕行,针对斜线填充图样1115的图像区域的避障策略是上方通过。这样就可以便捷地对稳定环境下机器人的移动路径进行规划,而不仅仅依靠机器人自身携带的传感器进行路径规划,并且由于语义地图给出的环境信息可靠度较高,有助于提升规划的路径的可靠性。无人机2可以按照规划好的移动路径从与路径起点3对应的位置移动至与路径终点4对应的位置。As shown in Figure 1, the semantic map can be used as the input of path planning, and the obstacle avoidance strategy of the corresponding image region can be determined based on the semantic information of each image region in the semantic map, and then the path planning can be carried out based on the obstacle avoidance strategy. In the semantic map of FIG. 1 , the obstacle avoidance strategy for the image areas of the origin fill pattern 1111 and the pure white fill pattern 1112 is pass, and the obstacle avoidance strategy for the image areas of the horizontal line fill pattern 1113 and the grid fill pattern 1114 is to go around Line, the obstacle avoidance strategy for the image area of the diagonal fill pattern 1115 is to pass over. In this way, the moving path of the robot in a stable environment can be easily planned, instead of relying only on the sensors carried by the robot itself for path planning, and because the environmental information given by the semantic map is highly reliable, it helps to improve the planned path. reliability. The UAV 2 can move from the position corresponding to the start point 3 of the path to the position corresponding to the end point 4 of the path according to the planned movement path.
需要说明的是,上述避障策略仅为示例,避障策略可以具有更多或更少的策略。例如,避障策略仅包括:通行和绕行。又例如,避障策略包括通行、绕行、上方通过、下方通过、快速通过、低速通过等,在此不做限定。It should be noted that the above obstacle avoidance strategy is only an example, and the obstacle avoidance strategy may have more or less strategies. For example, an obstacle avoidance strategy consists only of: passing and detouring. For another example, the obstacle avoidance strategy includes passing, detouring, passing above, passing below, passing quickly, passing at low speed, etc., which are not limited here.
本申请实施例提供的路径规划方法、路径规划装置、路径规划系统和介质,由于语义地图中各个图像区域的语义信息与可移动平台的避障策略之间具有对应关系,使得可移动平台可以基于对应的避障策略进行路径规划,可以在复杂场景中实现更为合理、高效的路径规划。The path planning method, path planning device, path planning system and medium provided by the embodiments of the present application have a corresponding relationship between the semantic information of each image area in the semantic map and the obstacle avoidance strategy of the movable platform, so that the movable platform can be based on The corresponding obstacle avoidance strategy is used for path planning, which can achieve more reasonable and efficient path planning in complex scenarios.
本申请实施例提供的路径规划方法、路径规划装置、路径规划系统和介质,语义地图中包括的环境信息可编辑,使得用户可根据实际场景编辑环境信息。与相关技术中的机器人实时监测环境不同,语义地图是可以预先修改,根据实际情况配置的,提高了其应用的灵活性。In the path planning method, path planning device, path planning system and medium provided by the embodiments of the present application, the environmental information included in the semantic map can be edited, so that the user can edit the environmental information according to the actual scene. Different from the real-time monitoring environment of robots in related technologies, the semantic map can be modified in advance and configured according to the actual situation, which improves the flexibility of its application.
图2为本申请另一实施例提供的路径规划方法、路径规划装置、路径规划系统和介质的应用场景。如图2所示,以搭载在可移动平台10上的作业设备14为例进行说明。FIG. 2 is an application scenario of a path planning method, a path planning device, a path planning system, and a medium provided by another embodiment of the present application. As shown in FIG. 2 , the working equipment 14 mounted on the movable platform 10 will be described as an example.
图2中可移动平台10包括本体11、承载体13及作业设备14(如植保设 备、测绘设备或图像捕捉装置等)。尽管可移动平台10被描述为飞行器,然而这样的描述并不是限制,前述描述的任何类型的可移动平台都适用。在某些实施例中,测绘装置可以直接位于可移动平台10上,而不需要承载体13。可移动平台10可以包括动力机构15,传感系统12。此外,该可移动平台10还可以包括通讯系统。The movable platform 10 in Fig. 2 includes a main body 11, a carrier 13 and operation equipment 14 (such as plant protection equipment, surveying and mapping equipment or image capturing devices, etc.). Although the movable platform 10 is described as an aircraft, such description is not limiting and any type of movable platform previously described is applicable. In some embodiments, the mapping device may be located directly on the movable platform 10 without the need for the carrier 13 . The movable platform 10 may include a power mechanism 15 , a sensing system 12 . In addition, the mobile platform 10 may also include a communication system.
通讯系统能够实现可移动平台10与具有通讯系统的控制终端20通过天线22收发的无线信号30进行通讯,天线22设置在本体21上。通讯系统可以包括任何数量的用于无线通讯的发送器、接收器、及/或收发器。The communication system can realize the communication between the movable platform 10 and the control terminal 20 having the communication system through the wireless signal 30 sent and received by the antenna 22 , and the antenna 22 is arranged on the main body 21 . A communication system may include any number of transmitters, receivers, and/or transceivers for wireless communication.
在某些实施例中,控制终端20可以向可移动平台10、承载体13及作业设备14中的一个或者多个提供控制指令,并且从可移动平台10、承载体13及作业设备14中的一个或者多个中接收信息(如障碍物、可移动平台10、承载体13或者作业设备14的位置及/或运动信息,负载感测的数据,如液位信息、流量信息、温度信息等)。在某些实施例中,控制终端20的控制数据可以包括关于位置、运动、制动的指令,用于对可移动平台10、承载体13及/或作业设备14的控制。例如,控制数据可以导致可移动平台10位置及/或方向的改变(如通过控制动力机构15),或者导致承载体13相对于可移动平台10的运动(如通过对承载体13的控制)。控制终端20的控制数据可以导致负载控制,如控制喷洒设备的操作(开启喷洒、停止喷洒、控制流量、喷洒角度、喷洒液体配比等)。在某些实施例中,可移动平台10、承载体13及/或作业设备14的通讯可以包括一个或者多个传感器(如距离传感器12、水位传感器、角度传感器等)发出的信息。通讯可以包括从一个或者多个不同类型的传感器(如GPS传感器、运动传感器、惯性传感器、近程传感器或者影像传感器)传送的感应信息。控制终端20传送提供的控制数据可以用于控制可移动平台10、承载体13或者作业设备14中一个或者多个的状态。可选地,承载体13及作业设备14中一个或多个可以包括通讯模块,用于与控制终端20通讯,以便控制终端20可以单独地通讯或者控制可移动平台10、承载体13及作业设备14。其中,控制终端20可以为可移动平台10的遥控器,也可以为诸如手机、iPad、可穿戴电子设备等能够用于控制可移动平台10的智能电子设备。In some embodiments, the control terminal 20 may provide control instructions to one or more of the movable platform 10 , the carrier 13 , and the work equipment 14 , and provide control instructions from the movable platform 10 , the carrier 13 , and the work equipment 14 . One or more of the received information (such as position and/or motion information of obstacles, movable platform 10, carrier 13 or work equipment 14, load sensing data, such as liquid level information, flow information, temperature information, etc.) . In some embodiments, the control data of the control terminal 20 may include instructions regarding position, movement, and braking for the control of the movable platform 10 , the carrier 13 and/or the work equipment 14 . For example, the control data may cause a change in the position and/or orientation of the movable platform 10 (eg, by controlling the power mechanism 15), or cause movement of the carrier 13 relative to the movable platform 10 (eg, by controlling the carrier 13). The control data of the control terminal 20 can lead to load control, such as controlling the operation of the spraying equipment (starting spraying, stopping spraying, controlling flow rate, spraying angle, spraying liquid ratio, etc.). In some embodiments, the communications of the movable platform 10, the carrier 13, and/or the work equipment 14 may include information from one or more sensors (eg, distance sensor 12, water level sensor, angle sensor, etc.). Communication may include sensory information transmitted from one or more different types of sensors, such as GPS sensors, motion sensors, inertial sensors, proximity sensors, or image sensors. The control data transmitted by the control terminal 20 may be used to control the state of one or more of the movable platform 10 , the carrier 13 or the work equipment 14 . Optionally, one or more of the carrier 13 and the work equipment 14 may include a communication module for communicating with the control terminal 20 so that the control terminal 20 can communicate with or control the movable platform 10, the carrier 13 and the work equipment individually 14. The control terminal 20 may be a remote controller of the movable platform 10 , or may be an intelligent electronic device such as a mobile phone, an iPad, a wearable electronic device, etc., which can be used to control the movable platform 10 .
需要说明的是,控制终端20可以远离可移动平台10,以实现对可移动 平台10的远程控制,可以固定或可拆卸地设于可移动平台10上,具体可以根据需要设置。It should be noted that the control terminal 20 can be far away from the movable platform 10 to realize remote control of the movable platform 10, and can be fixedly or detachably provided on the movable platform 10, and can be specifically set as required.
在某些实施例中,可移动平台10可以与除了控制终端20之外的其它远程设备,或者非控制终端20的远程设备通讯。控制终端20也可以与另外一个远程设备及可移动平台10进行通讯。例如,可移动平台10及/或控制终端20可以与另一个可移动平台或者另一个可移动平台的承载体或负载通讯。当有需要的时候,另外的远程设备可以是第二终端或者其它计算设备(如计算机、桌上型电脑、平板电脑、智能手机、或者其它移动设备)。该远程设备可以向可移动平台10传送数据(如传输语义地图),从可移动平台10接收数据(如障碍物信息),传送数据给控制终端20,及/或从控制终端20接收数据。可选地,该远程设备可以连接到因特网或者其它电信网络,以使从可移动平台10及/或控制终端20接收的数据上传到网站或者服务器上。In some embodiments, the removable platform 10 may communicate with other remote devices other than the control terminal 20 , or with remote devices other than the control terminal 20 . The control terminal 20 may also communicate with another remote device and the movable platform 10 . For example, the movable platform 10 and/or the control terminal 20 may be in communication with another movable platform or a carrier or payload of another movable platform. When desired, the additional remote device may be a second terminal or other computing device (eg, a computer, desktop, tablet, smartphone, or other mobile device). The remote device may transmit data to the mobile platform 10 (eg, transmit a semantic map), receive data (eg, obstacle information) from the mobile platform 10 , transmit data to the control terminal 20 , and/or receive data from the control terminal 20 . Optionally, the remote device may be connected to the Internet or other telecommunication network to allow data received from the removable platform 10 and/or the control terminal 20 to be uploaded to a website or server.
需要说明的是,可移动平台10还可以是陆地机器人、无人车、水下机器人等,在此不做限定。It should be noted that the movable platform 10 may also be a land robot, an unmanned vehicle, an underwater robot, etc., which is not limited herein.
图3为本申请实施例提供的路径规划方法的流程示意图。如图3所示,该路径规划方法,用于规划可移动平台的移动路径,可以包括操作S301~操作S305。FIG. 3 is a schematic flowchart of a path planning method provided by an embodiment of the present application. As shown in FIG. 3 , the path planning method, for planning the moving path of the movable platform, may include operations S301 to S305 .
在操作S301,获取可移动平台运行环境的语义地图,语义地图中各个图像区域的语义信息与可移动平台的避障策略具有对应关系。In operation S301, a semantic map of the operating environment of the movable platform is obtained, and the semantic information of each image area in the semantic map has a corresponding relationship with the obstacle avoidance strategy of the movable platform.
在本实施例中,语义地图可以是由用户输入至可移动平台或该可移动平台的控制终端的。语义地图也可以是可移动平台或该可移动平台的控制终端自动下载的,如基于可移动平台当前的位置信息从语义地图集合中搜索得到的。语义地图也可以是存储在可移动平台或该可移动平台的控制终端的本地中,在可移动平台上电后自动从存储空间中读取的。语义地图可以是由其它电子设备绘制的,也可以是由自身预先绘制的。In this embodiment, the semantic map may be input to the movable platform or the control terminal of the movable platform by the user. The semantic map may also be automatically downloaded by the movable platform or the control terminal of the movable platform, for example, searched from the semantic map collection based on the current location information of the movable platform. The semantic map may also be stored locally in the movable platform or the control terminal of the movable platform, and automatically read from the storage space after the movable platform is powered on. Semantic maps can be drawn by other electronic devices or pre-drawn by themselves.
语义地图可以包括多个图像区域,每个图像区域中各自的像素对应的避障策略相同。例如,麦田区域中各像素对应的语义信息都是麦田,麦田区域对应的避障策略是通行。可以分别为每个像素设置对应的语义信息,也可以仅为每个图像区域设置对应的语义信息,在此不做限定。The semantic map may include multiple image areas, and the corresponding obstacle avoidance strategies for the respective pixels in each image area are the same. For example, the semantic information corresponding to each pixel in the wheat field area is wheat field, and the obstacle avoidance strategy corresponding to the wheat field area is pass. Corresponding semantic information may be set for each pixel respectively, or only corresponding semantic information may be set for each image area, which is not limited herein.
语义地图中图像区域的语义信息与可移动平台的避障策略的对应关系, 可以是由用户设置的,也可以是由厂商设置的,还可以是由绘制该语义地图的用户设置的,在此不做限定。上述对应关系可以由用户进行修改,如修改语义地图中图像区域、修改图像区域的语义信息、修改与语义信息对应的避障策略等。例如,避障策略包括:侧面绕行策略、上方通过策略或下方通过策略中至少一种。The correspondence between the semantic information of the image area in the semantic map and the obstacle avoidance strategy of the mobile platform can be set by the user, by the manufacturer, or by the user who draws the semantic map. Here Not limited. The above corresponding relationship can be modified by the user, such as modifying the image area in the semantic map, modifying the semantic information of the image area, modifying the obstacle avoidance strategy corresponding to the semantic information, and the like. For example, the obstacle avoidance strategy includes at least one of a side detour strategy, an upper pass strategy, or a downward pass strategy.
图4为本申请实施例提供的语义地图的示意图。FIG. 4 is a schematic diagram of a semantic map provided by an embodiment of the present application.
如图4所示,该语义地图中包括六个图像区域,其中,各图像区域的语义信息分别为:麦田、水面、建筑、禁飞区、玉米地和高压线塔。各图像区域对应的避障策略可以为:通行、高速通行、绕行、禁止飞行、上方通过等。As shown in Figure 4, the semantic map includes six image areas, wherein the semantic information of each image area is: wheat field, water surface, building, no-fly zone, cornfield and high-voltage line tower. The obstacle avoidance strategy corresponding to each image area can be: passing, high-speed passing, detouring, no flight, passing above, etc.
需要说明的是,本申请的实施例还可以进一步设置与避障策略对应的作业状态。例如,上述方法还可以包括如下操作,当避障策略包括上方通过时,设置可移动平台的作业状态为禁止作业。例如,禁止作业包括如下至少一种:禁止喷洒、禁止拍摄、禁止测绘等。这样有效提升了针对语义地图的各区域设置对应的作业状态的便捷度。It should be noted that, in the embodiment of the present application, an operation state corresponding to the obstacle avoidance strategy may be further set. For example, the above method may further include the following operation: when the obstacle avoidance strategy includes passing over, setting the operation status of the movable platform to prohibit operation. For example, the prohibition of operations includes at least one of the following: prohibition of spraying, prohibition of photographing, prohibition of surveying and mapping, and the like. This effectively improves the convenience of setting the corresponding job status for each region of the semantic map.
在操作S303,根据语义地图,确定语义地图中目标图像区域的语义信息。In operation S303, the semantic information of the target image region in the semantic map is determined according to the semantic map.
在本实施例中,目标图像区域可以是移动路径可能需要经过的图像区域。参考图1所示,语义地图1中与无人机的当前位置对应的图像区域的标号为1111,则标号为1111的图像区域是目标图像区域。无人机沿着当前移动方向移动时会经过标号为1113、1114、1112和1115的图像区域,则标号为1113、1114、1112和1115的图像区域是目标图像区域。无人机沿着当前移动方向移动时不会经过标号为1116的图像区域,则标号为1116的图像区域不是目标图像区域。In this embodiment, the target image area may be an image area that the moving path may need to pass through. Referring to FIG. 1 , the image area corresponding to the current position of the drone in the semantic map 1 is labeled 1111, and the image area labeled 1111 is the target image area. When the drone moves along the current moving direction, it will pass through the image areas marked 1113, 1114, 1112 and 1115, and the image areas marked 1113, 1114, 1112 and 1115 are the target image areas. When the drone moves along the current moving direction, it will not pass through the image area marked 1116, then the image area marked 1116 is not the target image area.
在确定了目标图像区域之后,就可以基于上述对应关系从语义地图中确定与该目标图像区域对应的避障策略,以便基于该避障策略进行路径规划。After the target image area is determined, an obstacle avoidance strategy corresponding to the target image area can be determined from the semantic map based on the above-mentioned correspondence, so as to perform path planning based on the obstacle avoidance strategy.
在一个实施例中,根据语义地图,确定语义地图中目标图像区域的语义信息可以包括如下操作。首先,根据可移动平台的初始路径点和目标路径点在语义地图中对应的位置信息以及语义地图,确定目标图像区域。然后,根据目标图像区域,确定目标图像区域的语义信息。其中,初始路径点和目标路径点可以是由用户设定的,如用户设定可移动平台由位置A移动至位置B,则位置A是初始路径点,位置B是目标路径点。In one embodiment, according to the semantic map, determining the semantic information of the target image region in the semantic map may include the following operations. First, the target image area is determined according to the corresponding position information of the initial waypoint of the movable platform and the target waypoint in the semantic map and the semantic map. Then, according to the target image area, the semantic information of the target image area is determined. The initial waypoint and the target waypoint may be set by the user. For example, if the user sets the movable platform to move from position A to position B, then position A is the initial waypoint and position B is the target waypoint.
初始路径点和目标路径点可以是由可移动平台自动确定的,如用户通过控制终端给可移动平台发送了返航指令、结束作业指定,或者可移动平台检测到了被劫持风险、接收到来自空管的返航指令、已完成预设作业任务时,以可移动平台的当前位置为初始路径点,以可移动平台的起始移动路径点为目标路径点。以可移动平台是无人机为例,可移动平台的初始路径点是返航起点,可移动平台的目标路径点是返航终点。The initial waypoint and the target waypoint can be automatically determined by the mobile platform. For example, the user sends the return-to-home command to the mobile platform through the control terminal, and specifies the end of the operation. When the return-to-home command is given and the preset task has been completed, the current position of the movable platform is used as the initial path point, and the initial moving path point of the movable platform is used as the target path point. Taking the movable platform as an example of a UAV, the initial path point of the movable platform is the starting point of the return home, and the target way point of the movable platform is the return end point.
图5为本申请实施例提供的返航起点和返航终点的示意图。FIG. 5 is a schematic diagram of a return-to-home origin and a return-to-home end point according to an embodiment of the present application.
如图5所示,可以通过文件加载等方式在语义地图上标注与返航起点和返航终点对应的标记,该标记包括但不限于:三角形、原点、圆圈、十字线、瞄准标记等。该返航起点和返航终点可以通过用户操作设置的,如用户点击了语义地图上的两个位置,如用户输入的一个或多个坐标。该返航起点和返航终点可以是由可移动平台自动设置的,如开始返航时的起点坐标作为返航起点、可移动平台开始作业时的起点坐标作为返航终点。可以在语义地图上显示初始路径点和目标路径点。As shown in FIG. 5 , marks corresponding to the return origin and return destination can be marked on the semantic map by means of file loading, etc. The marks include but are not limited to: triangles, origins, circles, crosshairs, aiming marks, etc. The return-to-home start point and the return-to-home end point can be set through user operations, for example, the user clicks two positions on the semantic map, such as one or more coordinates input by the user. The return-to-home origin and return-to-home end point can be automatically set by the movable platform. For example, the starting point coordinates when the return-to-home is started is used as the return-to-home origin point, and the starting point coordinates when the movable platform starts to operate is used as the return-to-home end point. The initial and target waypoints can be displayed on the semantic map.
具体地,可以通过连接初始路径点和目标路径点来确定两点之间连线经过了哪些图像区域,将这些图像区域作为目标图像区域。需要说明的是,对于目标图像区域对应的避障策略是绕行时,则需要将该目标图像区域相邻的至少一个图像区域增加到目标图像区域中,以便形成连续的移动路径。Specifically, by connecting the initial waypoint and the target waypoint, it can be determined which image areas the line between the two points passes through, and these image areas are used as the target image area. It should be noted that when the obstacle avoidance strategy corresponding to the target image area is detour, at least one image area adjacent to the target image area needs to be added to the target image area to form a continuous moving path.
在一个实施例中,根据语义地图,确定语义地图中目标图像区域的语义信息可以包括如下操作。首先,根据可移动平台在语义地图中对应的位置信息以及语义地图,确定目标图像区域。然后,根据目标图像区域,确定目标图像区域的语义信息。In one embodiment, according to the semantic map, determining the semantic information of the target image region in the semantic map may include the following operations. First, according to the corresponding position information of the movable platform in the semantic map and the semantic map, the target image area is determined. Then, according to the target image area, the semantic information of the target image area is determined.
例如,用户通过打杆的方式控制无人机飞行或控制陆地机器人移动,在该场景下,没有初始路径点和目标路径点,可移动平台是响应与打杆对应的控制指令(如前进、后退、左转或右转等)进行移动。此时可以基于可移动平台当前所在的图像区域以及沿当前移动方向延伸后会相交的指定个数图像区域,作为目标图像区域。例如,可移动平台当前位置对应于语义地图中的当前图像区域,以及沿当前移动方向距离该当前图像区域最近的一个或多个图像区域作为目标图像区域。For example, the user controls the flight of the drone or controls the movement of the land robot by using the stick. In this scenario, there is no initial waypoint and target waypoint, and the movable platform responds to the control commands (such as forward, backward) corresponding to the stick. , turn left or right, etc.) to move. In this case, the target image area can be based on the image area where the movable platform is currently located and the specified number of image areas that will intersect after extending along the current moving direction. For example, the current position of the movable platform corresponds to the current image area in the semantic map, and one or more image areas closest to the current image area along the current moving direction are used as the target image area.
在操作S305,根据目标图像区域的语义信息对应的可移动平台的避障策 略,规划可移动平台避开目标图像区域对应的目标对象的移动路径。In operation S305, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, a moving path for the movable platform to avoid the target object corresponding to the target image area is planned.
在本实施例中,可以基于目标图像区域的语义信息和目标图像区域的轮廓来规划移动路径。例如,对于存在初始路径点和目标路径点的场景中,可以确定初始路径点和目标路径点之间的连线,如果连线与语义信息是绕行的目标图像区域相交,则可以基于该目标图像区域的轮廓生成替代移动路径(或多个路径点)以代替连线中与该目标图像区域相交的线段(或多个路径点)。其中,替代移动路径可以与该目标图像区域的至少部分轮廓共形或不共性。替代移动路径与该目标图像区域的轮廓之间需要设置安全距离。In this embodiment, the movement path can be planned based on the semantic information of the target image area and the outline of the target image area. For example, in a scene with an initial waypoint and a target waypoint, the connecting line between the initial waypoint and the target waypoint can be determined. If the connecting line intersects the target image area whose semantic information is a detour, the target image area can be determined based on the target. The contour of the image area generates an alternate movement path (or waypoints) in place of the segment (or waypoints) in the line that intersect the target image area. Wherein, the alternative movement path may be conformal or non-conformal to at least part of the contour of the target image area. A safety distance is required between the alternate movement path and the outline of this target image area.
又例如,对于不存在初始路径点和目标路径点的场景中,可移动平台即将移动至的目标图像区域的语义信息如果是绕行,则可以基于该目标图像区域的轮廓生成替代移动路径(或多个路径点)以代替连线中与该目标图像区域相交的线段(或多个路径点)。For another example, in a scene where there are no initial waypoints and no target waypoints, if the semantic information of the target image area to which the movable platform is about to move is a detour, an alternative movement path (or multiple waypoints) in place of the segment (or multiple waypoints) in the line that intersect the target image area.
在一个实施例中,上述方法还包括:提取语义地图的各区域的轮廓,以便至少基于目标图像区域的轮廓生成移动路径。例如,对于避障策略是绕行策略对应的图像区域,可以提取该图像区域的轮廓,然后基于该轮廓生成共形路径或相比于共形路径更加平滑的移动路径。其中,提取该图像区域的轮廓可以是在进行路径规划之前就完成的,也可以是在进行路径规划的过程中完成的,在此不做限定。In one embodiment, the above method further includes: extracting the contours of each region of the semantic map, so as to generate a movement path based at least on the contours of the target image region. For example, for the image area corresponding to the obstacle avoidance strategy, the contour of the image area can be extracted, and then a conformal path or a smoother moving path than the conformal path can be generated based on the contour. The extraction of the contour of the image region may be completed before the path planning is performed, or may be completed during the path planning process, which is not limited herein.
此外,在初步确定了移动路径之后,还可以进一步对该移动路径进行优化,例如,可移动平台在沿着该移动路径进行移动的过程中,尽量多的满足以下条件:尽量减少触发诸如急停、刹车等操作指令、尽量缩短路径长度、尽量降低能量消耗、尽量提升可移动平台的移动安全性等。In addition, after the movement path is preliminarily determined, the movement path can be further optimized. For example, during the movement of the movable platform along the movement path, the following conditions should be met as much as possible: minimize triggers such as emergency stop , braking and other operating instructions, shorten the path length as much as possible, reduce energy consumption as much as possible, and improve the movement safety of the movable platform as much as possible.
例如,移动路径满足以下至少一种条件:移动路径上的路径点与目标对象之间的距离大于安全距离;可移动平台从移动路径的初始路径点移动至目标路径点的资源消耗最优,资源包括以下至少一种:路径长度、能量或时间;移动路径的平滑度满足可移动平台的机动要求。其中,安全距离可以与可移动平台的尺寸、可移动平台的作业半径等相关,以保证可移动平台的飞行安全和作业效果。For example, the movement path satisfies at least one of the following conditions: the distance between the waypoint on the movement path and the target object is greater than the safety distance; the resource consumption of the movable platform from the initial waypoint of the movement path to the target waypoint is optimal, and the resources It includes at least one of the following: path length, energy or time; the smoothness of the moving path meets the maneuvering requirements of the movable platform. Among them, the safety distance may be related to the size of the movable platform, the working radius of the movable platform, etc., so as to ensure the flight safety and operation effect of the movable platform.
本申请实施例提供的路径规划方法,由于语义地图中各个图像区域的语义信息与可移动平台的避障策略之间具有对应关系,使得可以借助语义地图 中包含的语义信息补充可移动平台的环境信息,并基于与该语义信息对应的移动策略规划移动路径。改善了相关技术中可移动平台通常通过自身复杂的环境探测传感器,来获取其运行环境信息以进行路径规划,造成成本高且能耗大的问题。尤其是填补了针对较稳定环境下可移动平台路径规划的技术空白,至少部分地满足了用户对低成本、可复用的路径规划需求。In the path planning method provided by the embodiments of the present application, since there is a correspondence between the semantic information of each image area in the semantic map and the obstacle avoidance strategy of the movable platform, the environment of the movable platform can be supplemented by the semantic information contained in the semantic map information, and plan the movement path based on the movement strategy corresponding to the semantic information. In the related art, the movable platform usually obtains its operating environment information through its own complex environment detection sensors to perform path planning, resulting in the problems of high cost and high energy consumption. In particular, it fills the technical gap of path planning for movable platforms in a relatively stable environment, and at least partially satisfies users' needs for low-cost, reusable path planning.
以下对更新语义地图进行示例性说明。An exemplary description of updating the semantic map is given below.
为了提升基于语义地图进行路径规划的适用性,用户可以基于自身需求对语义地图进行更新,使得更新后的语义地图更符合用户的需求或与可移动平台当前所处环境的适配度。In order to improve the applicability of path planning based on the semantic map, users can update the semantic map based on their own needs, so that the updated semantic map is more in line with the user's needs or the compatibility with the current environment of the mobile platform.
在一个实施例中,在获取可移动平台运行环境的语义地图之前,上述方法还可以包括如下操作。In one embodiment, before acquiring the semantic map of the operating environment of the mobile platform, the above method may further include the following operations.
首先,获取可移动平台运行环境的初始语义地图。然后,获取基于用户操作生成的语义地图更新信息。接着,根据语义地图更新信息更新初始语义地图,以得到可移动平台运行环境的语义地图。First, an initial semantic map of the mobile platform runtime environment is obtained. Then, the update information of the semantic map generated based on the user operation is obtained. Next, the initial semantic map is updated according to the semantic map update information, so as to obtain the semantic map of the operating environment of the mobile platform.
其中,初始语义地图可以是从存储空间中读取出的语义地图,或者从网络中获取的语义地图,或者由用户输入的语义地图。该初始语义地图可以在交互界面中进行显示,以便用进行编辑。用户操作可以是通过控制终端输入的。例如,控制终端上设置有按键、拨杆等部件,用户可以通过操作这些部件输入语义地图更新信息。又例如,控制终端上可以包括显示屏,用户可以通过显示屏上显示的交互组件(如虚拟的按键、摇杆等)来输入语义地图更新信息。The initial semantic map may be a semantic map read from a storage space, a semantic map obtained from a network, or a semantic map input by a user. This initial semantic map can be displayed in an interactive interface for editing. User operations may be input through the control terminal. For example, the control terminal is provided with components such as buttons and levers, and the user can input semantic map update information by operating these components. For another example, the control terminal may include a display screen, and the user may input semantic map update information through interactive components (such as virtual keys, joysticks, etc.) displayed on the display screen.
进一步地,用户操作还可以是基于手势识别、姿势识别、体感或语音识别等方式确定并输入。例如,用户可以通过倾斜控制终端,以控制交互界面上光标的位置、移动方向、或者其它方面。控制终端的倾斜可以由一个或者多个惯性传感器所侦测,并产生对应的指令(如运动指令)。再如,用户可以利用触控屏调整负载的操作参数(如喷洒参数、测绘参数等)、负载的姿态(通过承载体),或者可移动平台上的任何物体的其它方面。Further, the user operation may also be determined and input based on gesture recognition, gesture recognition, somatosensory, or voice recognition. For example, the user can tilt the control terminal to control the position, movement direction, or other aspects of the cursor on the interactive interface. The tilt of the control terminal can be detected by one or more inertial sensors, and corresponding commands (such as motion commands) are generated. For another example, the user can use the touch screen to adjust the operating parameters of the load (such as spray parameters, mapping parameters, etc.), the attitude of the load (through the carrier), or other aspects of any object on the movable platform.
例如,用户操作所针对的对象可以是与可移动平台通信连接的控制终端。用户在控制终端上输入以下至少一种信息:选取信息、点坐标输入信息、指定操作(如编辑、删除、新增)、对象以及该指定操作的参数值(如坐标值、 安全距离、语义信息、避障策略)等。其中,控制终端可以是一体式的,如遥控器上设置有处理器、存储器、显示屏等。控制终端可以是分体式的,如遥控器可以和其它电子设备共同构成控制终端,如遥控器和智能手机互连后共同构成控制终端。其中,智能手机上可以安装有应用(APP),该APP上可以输入操作指令、设置操作参数等。For example, the object to which the user operates may be a control terminal communicatively connected to the movable platform. The user inputs at least one of the following information on the control terminal: selection information, point coordinate input information, specified operation (such as edit, delete, add), object and parameter values of the specified operation (such as coordinate value, safety distance, semantic information) , obstacle avoidance strategies), etc. Wherein, the control terminal may be integrated, for example, the remote controller is provided with a processor, a memory, a display screen, and the like. The control terminal may be split. For example, the remote control and other electronic devices may form a control terminal. For example, the remote control and a smart phone may be interconnected to form a control terminal. Wherein, an application (APP) may be installed on the smart phone, and the APP may input operation instructions, set operation parameters, and the like.
在一个实施例中,上述方法还可以包括如下操作:提供用户交互界面,在用户交互界面上显示初始语义地图。In one embodiment, the above method may further include the following operations: providing a user interaction interface, and displaying the initial semantic map on the user interaction interface.
相应地,获取基于用户操作生成的语义地图更新信息可以包括如下操作:获取基于用户在用户交互界面上的操作生成的语义地图更新信息。Correspondingly, acquiring the semantic map update information generated based on the user operation may include the following operations: acquiring the semantic map update information generated based on the user's operation on the user interaction interface.
这样便于用户输入语义地图更新信息,以对语义地图进行编辑。In this way, it is convenient for the user to input semantic map update information to edit the semantic map.
图6为本申请实施例提供的用户交互界面的示意图。FIG. 6 is a schematic diagram of a user interaction interface provided by an embodiment of the present application.
如图6所示,该用户交互界面中可以包括编辑区域和效果展示区域。编辑区域中可以由用户输入语义地图更新信息。As shown in FIG. 6 , the user interaction interface may include an editing area and an effect displaying area. In the editing area, the user can input semantic map update information.
在一个实施例中,语义地图更新信息包括语义地图中更新的图像区域的位置、形状和语义信息。其中,部分语义信息可以没有避障策略,如针对建筑的避障策略是绕行,该对应关系可以是全局通用的,如果用户在语义地图上新增了表征建筑的图像区域,则无需单独为该表征建筑的图像区域设置避障策略,而是基于已有的对应关系自动将其避障策略设置为绕行。此外,对于已有的图像区域的位置、形状和语义信息,其中至少部分信息可以进行由用户进行编辑的,这样有效提升用户操作便捷度,也能更好地适用于更多的场景中。In one embodiment, the semantic map update information includes location, shape, and semantic information of the updated image region in the semantic map. Among them, some semantic information may not have an obstacle avoidance strategy. For example, the obstacle avoidance strategy for buildings is detour, and the corresponding relationship can be globally universal. If the user adds an image area representing the building on the semantic map, it is not necessary to create a separate The obstacle avoidance strategy is set in the image area representing the building, but its obstacle avoidance strategy is automatically set to detour based on the existing corresponding relationship. In addition, for the position, shape and semantic information of the existing image area, at least part of the information can be edited by the user, which effectively improves the convenience of the user's operation and can be better applied to more scenes.
参考图6所示,用户可以在编辑区域中对各部分信息进行更新,如新增一个对应关系,编辑对应关系或删除对应关系等。在编辑对应关系时,可以修改图案(如修改颜色、填充图案等),可以修改语义信息(如将麦田修改为果园),可以修改避障策略(如将通行修改为绕行或上方通过等)。Referring to FIG. 6 , the user can update each part of the information in the editing area, such as adding a corresponding relationship, editing the corresponding relationship, or deleting the corresponding relationship. When editing the corresponding relationship, you can modify the pattern (such as modifying the color, filling pattern, etc.), modify the semantic information (such as modifying the wheat field to an orchard), and modify the obstacle avoidance strategy (such as modifying the passage to detour or pass above, etc.) .
在一个实施例中,语义地图更新信息存储在配置文件中,使用的时候可以进行调取。这样不会直接修改原语义地图,便于重复使用该语义地图。In one embodiment, the semantic map update information is stored in a configuration file and can be retrieved when used. In this way, the original semantic map will not be directly modified, so that the semantic map can be reused.
图7为本申请实施例提供的更新语义地图的示意图。FIG. 7 is a schematic diagram of updating a semantic map according to an embodiment of the present application.
如图7所示,相对于初始语义地图而言,图7中表征玉米地的图像区域扩大了,该表征玉米地的图像区域可以是基于用户输入的语义地图更新信息 确定的,如用户手动在语义地图上放大了原语义地图中表征玉米地的图像区域(或重新画表征玉米地的新图像区域并覆盖表征玉米地的原图像区域、或删除表征玉米地的原图像区域后重画一个表征玉米地的新图像区域),并建立该图像区域与玉米地语义信息之间的对应关系。该表征玉米地的图像区域也可以是通过调用配置文件确定的,如用户或无人机在上一次进行植保作业后,确定如图7所示的玉米地的图像区域,并生成了配置文件,则在下一次作业时,可以直接调用上一次的配置文件对初始语义地图进行更新。As shown in FIG. 7 , compared with the initial semantic map, the image area representing the cornfield in FIG. 7 is enlarged, and the image area representing the cornfield may be determined based on the semantic map update information input by the user. The semantic map enlarges the image area representing the cornfield in the original semantic map (or redraws the new image area representing the cornfield and covers the original image area representing the cornfield, or deletes the original image area representing the cornfield and redraws a representation The new image area of the cornfield), and establish the correspondence between the image area and the semantic information of the cornfield. The image area characterizing the cornfield can also be determined by calling a configuration file. For example, after the last plant protection operation by the user or the drone, the image area of the cornfield as shown in Figure 7 is determined, and a configuration file is generated. Then in the next job, you can directly call the last configuration file to update the initial semantic map.
在一个实施例中,语义地图更新信息还包括语义地图中更新的图像区域的语义信息对应的避障策略。In one embodiment, the semantic map update information further includes an obstacle avoidance strategy corresponding to the semantic information of the updated image area in the semantic map.
具体地,可以由用户输入语义地图更新信息以设置更新的图像区域的语义信息对应的避障策略。例如,可以进一步设置避障策略,如在与地图中新添加了语义信息:礁石,礁石原本没有对应的避障策略,则需要提示用户进行设置,或者原本也有对应的避障策略,但是开放给用户进行修改。Specifically, the user can input the semantic map update information to set the obstacle avoidance strategy corresponding to the updated semantic information of the image area. For example, an obstacle avoidance strategy can be further set. For example, new semantic information is added to the map: Reef. The reef does not have a corresponding obstacle avoidance strategy, and the user needs to be prompted to set it, or there is a corresponding obstacle avoidance strategy, but it is open to User makes changes.
当然,本申请实施例也可以修改语义地图中已有的图像区域的语义信息对应的避障策略。例如,语义地图更新信息包括初始语义地图中的图像区域的语义信息对应的避障策略。Of course, the embodiment of the present application can also modify the obstacle avoidance strategy corresponding to the semantic information of the existing image regions in the semantic map. For example, the semantic map update information includes an obstacle avoidance strategy corresponding to the semantic information of the image region in the initial semantic map.
图8为本申请另一实施例提供的更新语义地图的示意图。FIG. 8 is a schematic diagram of updating a semantic map according to another embodiment of the present application.
如图8所示,初始语义地图中包括分别与水面、禁飞区、高压线塔、麦田、建筑和玉米地对应的图像区域。该初始地图中还包括与上述各图像区域对应的避障策略:通行、绕行、绕行、通行、绕行和上方通过等。如果本次作业任务中,无需对玉米地进行喷洒,或者随着玉米地中玉米不断长高,已不适用于上方通过的避障策略,则可以由用户将与玉米地对应的避障策略“上方通过”修改为“绕行”。这样有效提升了规划的移动路径的适用性。As shown in Figure 8, the initial semantic map includes image areas corresponding to water surface, no-fly zone, high-voltage line tower, wheat field, building, and cornfield, respectively. The initial map also includes obstacle avoidance strategies corresponding to the above image areas: passing, detouring, detouring, passing, detouring, and passing above. If there is no need to spray the cornfield in this task, or as the corn in the cornfield continues to grow taller, it is no longer suitable for the obstacle avoidance strategy of passing above, then the user can adjust the obstacle avoidance strategy corresponding to the cornfield” "Passing above" is changed to "Bypass". This effectively improves the applicability of the planned movement path.
图9为本申请另一实施例提供的更新语义地图的示意图。FIG. 9 is a schematic diagram of updating a semantic map according to another embodiment of the present application.
如图9,初始语义地图中包括分别与水面、禁飞区、高压线塔、麦田、建筑和玉米地对应的图像区域。用户可能为了提高经济收益,把玉米地上的玉米作物替换成了果树,使得原表征玉米地的图像区域,当前变更为表征果林的图像区域。此时,用户可以通过APP的用户交互界面将语义信息“玉米地”修改为“果林”,无需重新构建地图。As shown in Fig. 9, the initial semantic map includes image areas corresponding to water surface, no-fly zone, high-voltage line tower, wheat field, building and corn field respectively. The user may replace the corn crops on the corn field with fruit trees in order to improve economic benefits, so that the image area originally representing the corn field is now changed to the image area representing the fruit forest. At this point, the user can change the semantic information "cornfield" to "fruit forest" through the user interface of the APP without rebuilding the map.
图10A为本申请另一实施例提供的更新语义地图的示意图。FIG. 10A is a schematic diagram of updating a semantic map according to another embodiment of the present application.
如图10A所示,用户可以根据需求直接在语义地图中设置障碍物区域,该障碍物区域用于表征虚拟的障碍物的,使得规划的移动路径绕过该障碍物区域。这样有效增加了用调整诸如作业区域的便捷度。例如,一片区域已经人工进行过药液喷洒,无需重复作业;又例如,一片区域近期可能施工或拉网,此时,用户可以通过用户交互界面在语义地图中对应的位置设置障碍物区域,使得规划的路径绕过该障碍物区域,有效提升了操作的灵活度。As shown in FIG. 10A , the user can directly set an obstacle area in the semantic map as required, and the obstacle area is used to represent a virtual obstacle, so that the planned movement path bypasses the obstacle area. This effectively increases the convenience of adjusting, for example, the work area. For example, an area has been manually sprayed with liquid medicine, and there is no need to repeat the operation; for another example, an area may be constructed or netted in the near future. At this time, the user can set the obstacle area at the corresponding position in the semantic map through the user interface, so that the The planned path bypasses the obstacle area, which effectively improves the flexibility of operation.
以下对侧面绕行策略进行示例性说明。An exemplary description of the side detour strategy is given below.
侧面绕行策略可以是针对不适于从该图像区域对应的地理位置通过时采用的避障策略,降低可移动平台发生干涉的概率,并减小可移动平台在按照移动路径进行移动过程中,发生移动方向改变、急停、刹车等非期望的操作的概率,有助于提升移动效率,并有助于降低能耗。The side detour strategy can be an obstacle avoidance strategy that is not suitable for passing through the geographic location corresponding to the image area, reducing the probability of the movable platform interfering, and reducing the occurrence of the movable platform in the process of moving according to the moving path. The probability of undesired operations such as change of moving direction, emergency stop, braking, etc., helps to improve moving efficiency and helps reduce energy consumption.
在一个实施例中,侧面绕行策略包括:当目标对象的尺寸满足预设条件时,采用第一侧面绕行策略进行侧面绕行,当目标对象的尺寸不满足预设条件时,采用第二侧面绕行策略进行侧面绕行。例如,当目标图像区域中目标对象的尺寸过大,并且采用的类似弓字型移动路径时,如果采取侧面绕过障碍物,然后继续作业的策略,则会导致过多的移动路径是用于绕障碍物的,会降低作业效率。又例如,当目标图像区域中的目标对象的尺寸较小,可以很快地绕过该障碍物,则可以采取绕过障碍物的作业策略。In one embodiment, the side detour strategy includes: when the size of the target object satisfies the preset condition, adopting the first side detour strategy to perform the side detour, and when the size of the target object does not meet the preset condition, adopting the second detour strategy The side detour strategy performs a side detour. For example, when the size of the target object in the target image area is too large and a similar bow-shaped moving path is adopted, if the strategy of bypassing the obstacle sideways and then continuing the operation will result in too many moving paths being used for Going around obstacles will reduce work efficiency. For another example, when the size of the target object in the target image area is small and the obstacle can be quickly bypassed, a work strategy of bypassing the obstacle can be adopted.
例如,移动路径为弓字型路径,弓字型路径包括作业路径和横移路径,目标对象的尺寸是在垂直于作业路径的方向上目标对象的尺寸。其中,弓字型路径可以是移动路径在二维水平面上的投影,在三维空间中,该弓字型路径还可以包括针对各路径点的高度信息。For example, the moving path is a bow-shaped path, the bow-shaped path includes a work path and a traverse path, and the size of the target object is the size of the target object in a direction perpendicular to the work path. The bow-shaped path may be a projection of the moving path on a two-dimensional horizontal plane, and in a three-dimensional space, the bow-shaped path may also include height information for each path point.
图10B为本申请实施例提供的移动路径的示意图。FIG. 10B is a schematic diagram of a movement path provided by an embodiment of the present application.
如图10B所示,地图左边表征建筑的图形区域的避障策略和地图右边表征建筑的图像区域的避障策略不同,地图左边表征建筑(如工厂)的图形区域的尺寸明显大于地图右边表征建筑(如电线杆)的图像区域的尺寸。为提升作业效率,针对地图左边表征建筑的图形区域采取了切换至相邻的作业路径的避障策略,而针对地图左边表征建筑的图形区域采取了从侧边绕行以继续当前的作业路径。As shown in Figure 10B, the obstacle avoidance strategy of the graphic area representing the building on the left side of the map is different from the obstacle avoidance strategy of the image area representing the building on the right side of the map. The size of the graphic area representing the building (such as a factory) on the left side of the map is significantly larger than that on the right side of the map. The size of the image area (such as a utility pole). In order to improve the operation efficiency, the obstacle avoidance strategy of switching to the adjacent operation path is adopted for the graphic area representing the building on the left side of the map, and the side detour is adopted for the graphic area representing the building on the left side of the map to continue the current operation path.
具体地,可以通过比较目标对象的尺寸和可移动平台的作业路径间距确 定目标对象的尺寸是否满足预设条件。其中,目标对象的尺寸可以指目标对象的最大尺寸,如最大宽度、最大长度或最大高度等。Specifically, it can be determined whether the size of the target object satisfies the preset condition by comparing the size of the target object with the distance between the working paths of the movable platform. The size of the target object may refer to the maximum size of the target object, such as maximum width, maximum length, or maximum height.
例如,第一侧面绕行策略包括:移动至相邻的作业路径。第二侧面绕行策略包括:从侧边绕行以继续当前的作业路径。For example, a first side detour strategy includes moving to an adjacent work path. The second side detour strategy includes detouring from the side to continue the current work path.
其中,可以当目标对象的尺寸与作业路径间距之间的比值大于指定倍数时,采用第一侧面绕行策略,当目标对象的尺寸与作业路径间距之间的比值小于指定倍数时,采用第二侧面绕行策略,指定倍数可以由用户进行设定或修改。Among them, when the ratio between the size of the target object and the working path spacing is greater than the specified multiple, the first side detour strategy can be adopted, and when the ratio between the size of the target object and the working path spacing is smaller than the specified multiple, the second strategy is adopted. Side detour strategy, the specified multiple can be set or modified by the user.
需要说明的是,上述规划好的移动路径中各路径点的避障策略的优先级,是低于可移动平台在按照上述移动路径在移动过程中检测到的实际障碍物对应的避障策略的。例如,移动路径中某个路径点对应的避障策略是通行,但是,可移动平台移动至该路径点附近时检测到该路径点处存在障碍物,则应优先采用不导致可移动平台与该障碍物发生干涉的避障策略。It should be noted that the priority of the obstacle avoidance strategy of each path point in the above-mentioned planned moving path is lower than that of the obstacle avoidance strategy corresponding to the actual obstacle detected by the movable platform during the moving process according to the above-mentioned moving path. . For example, the obstacle avoidance strategy corresponding to a certain waypoint in the moving path is to pass. However, when the movable platform moves to the vicinity of the waypoint and detects that there is an obstacle at the waypoint, priority should be given to adopting a strategy that does not cause the movable platform to interact with the waypoint. An obstacle avoidance strategy that interferes with obstacles.
为了便于理解语义信息与避障策略之间的对应关系,表1中示例性列出了可移动平台是无人机场景中一些语义值与避障策略之间的对应关系。In order to facilitate the understanding of the correspondence between semantic information and obstacle avoidance strategies, Table 1 exemplarily lists the correspondence between some semantic values and obstacle avoidance strategies in the scene where the movable platform is a UAV.
表1Table 1
Figure PCTCN2020127623-appb-000001
Figure PCTCN2020127623-appb-000001
Figure PCTCN2020127623-appb-000002
Figure PCTCN2020127623-appb-000002
表1中还示出了安全距离的概念,以下对安全距离进行示例性说明。The concept of safety distance is also shown in Table 1, and the safety distance is exemplified below.
在一个实施例中,避障策略还包括安全距离信息,安全距离信息用于指示可移动平台相对于目标图像区域对应的目标对象的最小间距。In one embodiment, the obstacle avoidance strategy further includes safety distance information, where the safety distance information is used to indicate the minimum distance between the movable platform and the target object corresponding to the target image area.
如表1中所示,具有不同语义信息的图像区域各自可以具有不同的安全距离,以在保证移动安全性的基础上减少移动路径的长度。例如,相对于树木而言,在建筑物周围遇到需要可移动平台进行减速、急刹车等非期望操作的概率更高,如可能由于行人、人为设置的物体等导致该情形。因此,可以为语义地图中表征建筑物的图像区域设置更大的安全距离,如增大与语义值对应的安全距离的取值。又例如,相对于普通建筑物而言,电线产生的电磁辐射可能对控制终端与可移动平台之间的通讯造成较大的干扰,因此,可以为语义地图中表征电线的图像区域设置更大的安全距离。As shown in Table 1, image regions with different semantic information can each have different safety distances, so as to reduce the length of the movement path on the basis of ensuring movement safety. For example, compared with trees, there is a higher probability of encountering undesired operations such as deceleration and sudden braking around a building, which may be caused by pedestrians, human-made objects, etc. Therefore, a larger safety distance can be set for the image area representing the building in the semantic map, such as increasing the value of the safety distance corresponding to the semantic value. For another example, compared with ordinary buildings, the electromagnetic radiation generated by the electric wire may cause greater interference to the communication between the control terminal and the movable platform. Therefore, a larger image area can be set for the image area representing the electric wire in the semantic map. safe distance.
具体地,安全距离与以下至少一种相关:可移动平台的尺寸、可移动平台的作业半径。例如,避障策略包含安全距离信息,避障策略和语义信息有关,这样就可以便捷地确定安全距离信息和语义信息之间的对应关系。此外,由于不同的可移动设备各自具有不同的最小避障距离,如高速行驶下的路面机器人的刹停距离大于低速行驶下的路面机器人的刹停距离,相同行驶速度下,空中机器人的刹停距离大于路面机器人的刹停距离等。因此,可以分别基于可移动平台的最小避障距离设置安全距离,以提升可移动平台的安全性。Specifically, the safety distance is related to at least one of the following: the size of the movable platform, and the working radius of the movable platform. For example, the obstacle avoidance strategy contains the safety distance information, and the obstacle avoidance strategy is related to the semantic information, so that the correspondence between the safety distance information and the semantic information can be easily determined. In addition, since different movable devices have different minimum obstacle avoidance distances, for example, the braking distance of the road robot at high speed is greater than the braking distance of the road robot at low speed. At the same driving speed, the braking distance of the aerial robot The distance is greater than the braking distance of the road robot, etc. Therefore, the safety distance can be set based on the minimum obstacle avoidance distance of the movable platform, so as to improve the safety of the movable platform.
图11为本申请实施例提供的安全距离的示意图。FIG. 11 is a schematic diagram of a safety distance provided by an embodiment of the present application.
如图11所示,该安全距离可以是针对两种场景下的距离,参考图中的双向箭头线段所示。例如,图11左图中所示的安全距离,是针对语义地图中避障策略是绕行的图形区域,在可移动平台绕行某个图形区域对应的区域时,可移动平台与该区域之间的距离需要大于安全距离。图11右图中所示的安全距离,是针对可移动平台按照规划好的移动路径进行移动过程中,针对检测到的障碍物,需要控制可移动平台与该障碍物之间的距离大于安全距离。As shown in FIG. 11 , the safety distance may be a distance for two scenarios, as shown by the two-way arrow line segment in the reference figure. For example, the safety distance shown in the left image of Figure 11 is for the graphical area where the obstacle avoidance strategy in the semantic map is detour. When the movable platform detours the area corresponding to a certain graphical area, the distance between the movable platform and the area The distance between them needs to be greater than the safety distance. The safety distance shown in the right figure of Figure 11 is for the detected obstacle in the process of moving the movable platform according to the planned moving path, and it is necessary to control the distance between the movable platform and the obstacle to be greater than the safety distance .
表1中还示出了高度信息的概念,以下对高度信息进行示例性说明。参考图1所示,标号1115所示的图形区域对应的语义信息是玉米地,玉米地的高度虽然比麦田的高度高,但是,对于无人机而言,可以通过上方通过的方式进行移动,无需从侧面绕行,有助于减小移动路径的长度。The concept of height information is also shown in Table 1, and the height information is exemplified below. Referring to Fig. 1, the semantic information corresponding to the graphic area indicated by the symbol 1115 is cornfield. Although the height of cornfield is higher than that of wheatfield, for drones, it can move by passing through the top. Helps to reduce the length of the travel path by eliminating the need to detour from the side.
在一个实施例中,上述方法还可以包括如下操作,获取目标图像区域对应的高程信息。In one embodiment, the above method may further include the following operation: acquiring the elevation information corresponding to the target image area.
相应地,根据目标图像区域的语义信息对应的可移动平台的避障策略,规划可移动平台避开目标图像区域对应的目标对象的移动路径,包括:根据目标图像区域的语义信息对应的可移动平台的避障策略以及目标图像区域对应的高程信息,规划可移动平台避开目标图像区域对应的目标对象的移动路径。Correspondingly, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, planning the moving path of the movable platform to avoid the target object corresponding to the target image area, including: according to the semantic information of the target image area corresponding to the movable platform The platform's obstacle avoidance strategy and the elevation information corresponding to the target image area plan the moving path of the movable platform to avoid the target object corresponding to the target image area.
例如,高程信息可以是从具有高程信息的语义地图中读取的。该具有高程信息的语义地图可以是通过融合高程地图和语义地图得到的。又例如,该具有高程信息的语义地图可以是由用户自行标注高程信息后生成的。又例如,该具有高程信息的语义地图可以是由具有图像传感器和测距传感器的测绘设备直接生成的。高程信息可以是一个具体的高度值,也可以是一个高度范围等。For example, the elevation information may be read from a semantic map with elevation information. The semantic map with elevation information can be obtained by fusing the elevation map and the semantic map. For another example, the semantic map with elevation information may be generated by the user marking the elevation information by himself. For another example, the semantic map with elevation information may be directly generated by a mapping device with an image sensor and a ranging sensor. The elevation information can be a specific height value, or a height range, etc.
在一个实施例中,根据目标图像区域的语义信息对应的可移动平台的避障策略以及目标图像区域对应的高程信息,规划可移动平台避开目标图像区域对应的目标对象的移动路径可以包括如下操作。当避障策略包括上方通过时,根据目标图像区域的语义信息对应的可移动平台的避障策略以及目标图像区域对应的高程信息,规划可移动平台避开目标图像区域对应的目标对象的移动路径。In one embodiment, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area and the elevation information corresponding to the target image area, planning the moving path of the movable platform to avoid the target object corresponding to the target image area may include the following steps: operate. When the obstacle avoidance strategy includes passing above, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area and the elevation information corresponding to the target image area, plan the moving path of the movable platform to avoid the target object corresponding to the target image area .
图12为本申请另一实施例提供的语义地图的示意图。FIG. 12 is a schematic diagram of a semantic map provided by another embodiment of the present application.
如图12所示,该语义地图中除了包括多个分别具有不同语义信息的图像区域,还分别标注有各语义对应的高程信息。例如,语义信息是水面(或马路)的图像区域的高程信息是0米,禁飞区的高程信息是无穷大(∞)米,高压线塔的高程信息是小于20米(<20米),麦田的高程信息是1米,建筑的高程信息是大于10米(>10米),玉米地的高程信息是2~3米。基于以上信息可以针对不同的可移动平台进行更合适的路径规划。例如,无人机可以在高度超过4米的空中飞行,则针对玉米地可以采取上方通过的避障策略。又例如,路上机器人可以在地面行驶通过高压线塔区域,而无人机则需要绕行该高压线塔。As shown in FIG. 12 , the semantic map not only includes a plurality of image regions with different semantic information, but also is marked with elevation information corresponding to each semantic. For example, the elevation information of the image area where the semantic information is the water surface (or road) is 0 meters, the elevation information of the no-fly zone is infinite (∞) meters, the elevation information of the high-voltage line tower is less than 20 meters (<20 meters), the height information of the wheat field is less than 20 meters (<20 meters). The elevation information is 1 meter, the elevation information of the building is greater than 10 meters (>10 meters), and the elevation information of the cornfield is 2 to 3 meters. Based on the above information, more appropriate path planning can be performed for different movable platforms. For example, the drone can fly in the air at a height of more than 4 meters, and the obstacle avoidance strategy of passing above can be adopted for the cornfield. For another example, on-road robots can drive through the area of high-voltage line towers on the ground, while drones need to bypass the high-voltage line towers.
需要说明的是,该高程信息的高度值是相对于地面而言的,也可以是相对于水平面而言的,在此不做限定。对于环境信息较为固定的场景中而言,该高程信息的高度值可以是相对于预设的一个平面的,如地平面的高度值。It should be noted that the height value of the elevation information is relative to the ground, and may also be relative to the horizontal plane, which is not limited here. For a scene with relatively fixed environmental information, the height value of the elevation information may be relative to a preset plane, such as the height value of the ground plane.
在一个实施例中,可移动平台可以基于规划好移动路径进行移动。在移动过程中,需要基于实时监测到的障碍物信息进行避障。但是,相对于不采用语义地图进行路径规划的场景中,本实施例采取的传感器的复杂度可以大幅度降低。例如,相关技术在进行自动返航过程中,为了保证可移动平台的移动安全,可以采用诸如全向雷达以及诸如图像传感器等,而本申请的技术方案可以只采用双向雷达即可,在降低硬件成本的同时,也降低了机身重量、计算资源消耗和能源消耗等。In one embodiment, the movable platform may move based on a planned movement path. During the moving process, obstacle avoidance needs to be performed based on the obstacle information detected in real time. However, compared to a scenario in which a semantic map is not used for path planning, the complexity of the sensor adopted in this embodiment can be greatly reduced. For example, in the process of automatic return to home in the related art, in order to ensure the movement safety of the movable platform, such as omnidirectional radar and such as image sensors, etc., can be used, and the technical solution of the present application can only use two-way radar, which can reduce hardware costs. At the same time, it also reduces the body weight, computing resource consumption and energy consumption.
具体地,在根据目标图像区域的语义信息对应的可移动平台的避障策略,规划可移动平台避开目标图像区域对应的目标对象的移动路径之后,上述方法还可以包括如下操作:控制可移动平台基于移动路径和可移动平台通过传感器检测到的障碍物信息进行移动。其中,可移动平台通过传感器检测到障碍物信息可以采用相关技术中检测障碍物的方法,如基于图像、雷达(如激光雷达或超声波雷达等)、测距传感器等进行检测,在此不做限定。Specifically, after planning the moving path of the movable platform to avoid the target object corresponding to the target image area according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, the above method may further include the following operations: controlling the movable platform The platform moves based on the moving path and the obstacle information detected by the movable platform through the sensors. Among them, the mobile platform detects the obstacle information through the sensor, and can use the method of detecting obstacles in related technologies, such as detection based on image, radar (such as lidar or ultrasonic radar, etc.), ranging sensor, etc., which is not limited here. .
在一个实施例中,参考表1所示,当针对一个语音信息的图像区域具有多种避障策略时,可以基于诸如可移动平台的类型选取最合适的移动策略。例如,可移动平台是无人机,在控制可移动平台基于移动路径和可移动平台通过传感器检测到的障碍物信息进行移动的过程中,对于无人机检测到的障碍物,无人机从障碍物的上方通过的第一优先级高于从障碍物的下方通过的 第二优先级。这是由于针对无人机而言,其可以调整飞行高度,而低空中存在障碍物的概率大于高空中存在障碍物的概率,因此无人机从上方通过的安全概率大于从下方通过的安全概率。In one embodiment, referring to Table 1, when there are multiple obstacle avoidance strategies for an image area of a voice information, the most suitable movement strategy may be selected based on the type of movable platform. For example, the movable platform is an unmanned aerial vehicle. In the process of controlling the movable platform to move based on the moving path and the obstacle information detected by the movable platform through the sensor, for the obstacles detected by the unmanned aerial vehicle, the unmanned aerial vehicle will move from The first priority for passing over the obstacle is higher than the second priority for passing under the obstacle. This is because for drones, the flight height can be adjusted, and the probability of obstacles in low altitudes is greater than the probability of obstacles in high altitudes, so the safety probability of drones passing from above is greater than the safety probability of passing from below .
图13为本申请实施例提供的通过传感器检测到的障碍物信息进行移动的示意图。FIG. 13 is a schematic diagram of moving based on obstacle information detected by a sensor according to an embodiment of the present application.
如图13所示,以可移动平台是无人机为例进行示例性说明。无人机基于规划好的移动路径进行返航的过程中,在绕行禁飞区的过程中,检测到了障碍物信息。为了实现顺利返航,无人机可以偏离规划好的移动路径,以绕过障碍物。As shown in FIG. 13 , the movable platform is an unmanned aerial vehicle as an example for illustration. In the process of returning home based on the planned movement path, the UAV detected obstacle information during the process of circumventing the no-fly zone. In order to achieve a smooth return, the UAV can deviate from the planned movement path to bypass obstacles.
在一个实施例中,控制可移动平台基于移动路径和可移动平台通过传感器检测到的障碍物信息进行移动,包括:在传感器检测到的障碍物的置信度大于预设阈值时,控制可移动平台基于移动路径和可移动平台通过传感器检测到的障碍物信息进行移动,障碍物的置信度与重复检测到障碍物的次数以及检测到障碍物时的环境信息相关。In one embodiment, controlling the movable platform to move based on the moving path and information of obstacles detected by the movable platform through the sensor includes: when the confidence of the obstacle detected by the sensor is greater than a preset threshold, controlling the movable platform Based on the moving path and the obstacle information detected by the mobile platform through the sensor, the confidence of the obstacle is related to the number of times the obstacle is repeatedly detected and the environmental information when the obstacle is detected.
其中,如果障碍物的置信度小于一定阈值,则确定该障碍物的信息是不可靠的,可以忽略。如风雨天气下,可能会检测到树叶、雨滴等障碍物信息,但是这些障碍物的置信度较低,如在相邻的多个检测周期中检测的结果差别较大,则可以忽略该障碍物信息。例如,无人机在多次在同一位置检测到障碍物或无人机在一个较小的区域内连续检测到障碍物,则该障碍物信息的置信度较高。Among them, if the confidence of the obstacle is less than a certain threshold, it is determined that the information of the obstacle is unreliable and can be ignored. For example, in windy and rainy weather, information about obstacles such as leaves and raindrops may be detected, but the confidence of these obstacles is low. If the detection results in multiple adjacent detection cycles are quite different, the obstacle can be ignored. information. For example, if the UAV detects an obstacle at the same location multiple times or the UAV detects an obstacle continuously in a small area, the confidence of the obstacle information is high.
在一个实施例中,上述方法还包括:基于可移动平台检测到的障碍物更新语义地图。例如,如果确定语义地图中某个图像区域存在的障碍物信息满足一定条件,则可以确定该障碍物是较稳定的障碍物,可以针对该障碍物信息对语义地图进行更新。In one embodiment, the above method further includes: updating the semantic map based on the obstacles detected by the movable platform. For example, if it is determined that the obstacle information existing in a certain image area in the semantic map satisfies a certain condition, it can be determined that the obstacle is a relatively stable obstacle, and the semantic map can be updated according to the obstacle information.
图14为本申请实施例提供的基于可移动平台检测到的障碍物信息更新语义地图的示意图。FIG. 14 is a schematic diagram of updating a semantic map based on obstacle information detected by a movable platform according to an embodiment of the present application.
参考图13所示,以可移动平台是无人机为例进行说明,如果无人机在多次作业的过程中,在禁飞区附件的同一位置范围内检测到障碍物的次数(比例)满足预设条件,则可以确定该障碍物会较稳定的处于该区域。因此,如图14所示,可以在语义地图上对应的位置处设置一个障碍物区域。Referring to Figure 13, taking the mobile platform as an example of a UAV, if the UAV detects obstacles in the same position range near the no-fly zone during multiple operations (proportion) If the preset conditions are met, it can be determined that the obstacle will be stably located in the area. Therefore, as shown in Fig. 14, an obstacle area can be set at the corresponding position on the semantic map.
在本实施例中,可移动平台在按照规划好的移动路径进行移动的过程中,也可以基于检测到的障碍物信息更新语义地图。其中,可以是直接修改的初始语义地图,也可以是以配置文件的方式新增针对该语义地图的障碍物区域。在一个实施例中,还可以基于该障碍物的稳定度确定是否基于配置文件中的障碍物区域更新初始语义地图。例如,植保无人机在针对指定区域的作业过程中或返航过程中,连续多次在同一位置检测到障碍物信息,或者,在持续超过预设时间阈值(如1周、1个月、1年)在同一位置检测到障碍物信息,则可以将配置文件中稳定存在的障碍物区域固化在初始语义地图中。这样可以实现初始语义地图的自动更新。In this embodiment, in the process of moving according to the planned moving path, the movable platform may also update the semantic map based on the detected obstacle information. The initial semantic map may be directly modified, or an obstacle area for the semantic map may be added in the form of a configuration file. In one embodiment, whether to update the initial semantic map based on the obstacle area in the configuration file may also be determined based on the stability of the obstacle. For example, during the operation of the designated area or the process of returning home, the plant protection UAV detects the obstacle information at the same position for several consecutive times, or continuously exceeds the preset time threshold (such as 1 week, 1 month, 1 year) detected the obstacle information at the same position, the obstacle area that exists stably in the configuration file can be solidified in the initial semantic map. This enables automatic updating of the initial semantic map.
需要说明的是,障碍物区域可以是可移动平台基于预设规则自动对语义地图进行更新的,还可以是由用户自行设定的。例如,用户在进行一次作业之前,可以将在语义地图上无需作业或需要规避的区域(如可能存在障碍物的图像区域)设置障碍物区域,以满足用户的多样化需求。It should be noted that, the obstacle area may be automatically updated by the movable platform based on preset rules, or may be set by the user. For example, before a user performs an operation, an obstacle area can be set in an area that does not require operation or needs to be avoided on the semantic map (such as an image area where there may be obstacles) to meet the diverse needs of the user.
在一个实施例中,根据目标图像区域的语义信息对应的可移动平台的避障策略,规划可移动平台避开目标图像区域对应的目标对象的移动路径包括:首先,根据目标图像区域的三维位置信息和避障策略建立目标函数。然后,优化目标函数以确定可移动平台避开目标对象的移动路径。In one embodiment, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, planning the moving path of the movable platform to avoid the target object corresponding to the target image area includes: first, according to the three-dimensional position of the target image area Information and obstacle avoidance strategies establish objective functions. Then, the objective function is optimized to determine the movement path of the movable platform to avoid the target object.
其中,优化目标函数以确定可移动平台避开目标对象的移动路径可以包括:最小化目标函数以确定多个目标轨迹点对应的可移动平台的位置参数,多个目标轨迹点对应的可移动平台的位置参数使得目标函数的函数值最小。目标函数可以包括以下至少一种:碰撞代价函数,代表运动学和动力学约束的代价函数,避障策略中的安全距离会影响碰撞代价函数。另外,该目标函数还可以包含路径长度代价函数,用于约束通行方向(通过路径点的位置)。此外,该目标函数还可以包含动能损伤代价函数,用于约束飞行速度等。需要说明的是,以上所示的代价函数仅为示例性示出,不能理解为对本申请的限定。例如,多种可以影响到路径规划的参数都可以被设置对应的代价函数,如助理代价函数,可以用于约束移动方向,以约束移动过程中受到的阻力,如顺风(顺流)移动的能耗小于逆风移动的能耗,如在沥青路面移动的能耗小于在沙土地路面移动的能耗等。Wherein, optimizing the objective function to determine the moving path of the movable platform to avoid the target object may include: minimizing the objective function to determine the position parameters of the movable platform corresponding to the multiple target trajectory points, and the movable platform corresponding to the multiple target trajectory points. The positional parameters of , minimize the function value of the objective function. The objective function may include at least one of the following: a collision cost function, a cost function representing kinematic and dynamic constraints, and a safety distance in an obstacle avoidance strategy that affects the collision cost function. In addition, the objective function can also include a path length cost function, which is used to constrain the direction of travel (the location of the path point). In addition, the objective function can also include a kinetic energy damage cost function, which is used to constrain the flight speed, etc. It should be noted that the cost function shown above is only an example, and should not be construed as a limitation on the present application. For example, various parameters that can affect path planning can be set to corresponding cost functions, such as assistant cost functions, which can be used to constrain the direction of movement to constrain the resistance during movement, such as the energy of downwind (downstream) movement. The energy consumption is less than the energy consumption of moving against the wind, such as the energy consumption of moving on an asphalt road is less than that of moving on a sandy road.
图15为本申请实施例提供的移动路径的平滑度满足可移动平台的机动 要求的示意图。如图15所示,移动路径相对于多点之间的两两连线更加平滑,满足可移动平台的机动要求。Fig. 15 is a schematic diagram showing that the smoothness of the moving path provided by the embodiment of the present application satisfies the maneuvering requirement of the movable platform. As shown in Figure 15, the moving path is smoother than the two-to-two connection between multiple points, which meets the maneuvering requirements of the movable platform.
为了节省最小化该目标函数的运算量,可以从预测轨迹中采样多个预测轨迹点,并以采样后的多个预测轨迹点对应的无人机的位置参数为初值来最小化该目标函数。In order to save the calculation amount of minimizing the objective function, multiple predicted trajectory points can be sampled from the predicted trajectory, and the objective function can be minimized by taking the position parameters of the UAV corresponding to the sampled multiple predicted trajectory points as the initial value .
图16为本申请另一实施例提供的路径规划的流程示意图。FIG. 16 is a schematic flowchart of path planning provided by another embodiment of the present application.
如图16所示,以可移动平台是无人机为例进行说明,路径规划的流程可以主要包括3个部分:输入条件准备、算法规划、执行。下面依次介绍各阶段的具体内容。As shown in Figure 16, taking the mobile platform as an example of a UAV for illustration, the process of path planning can mainly include three parts: input condition preparation, algorithm planning, and execution. The specific content of each stage is introduced in turn.
一、关于输入条件1. About input conditions
该部分涉及的输入条件是操作人员预先为返航任务设定的一些参数。其中,至少部分参数无需用户每次执行任务时都需要设置的,如安全距离参数、初始路径起点和目标路径点等。The input conditions involved in this part are some parameters pre-set by the operator for the return-to-home task. Among them, at least some of the parameters do not need to be set by the user every time the user performs the task, such as the safety distance parameter, the initial path starting point and the target path point, etc.
具体地,用户可以设定移动路径的初始路径起点和目标路径点。以返航任务为例,返航任务是从当前机器人所在的位置,安全的返回目标点,因此可以由用户预先设定返航起点和返航终点。默认情况下,返航起点是机器人当前位置,返航终点可通过默认的归航点(home)点或者用户通过APP点击设定、或者通过配置文件的形式输入,在此不做限定。Specifically, the user can set the initial path starting point and the target path point of the moving path. Taking the return-to-home task as an example, the return-to-home task is to safely return to the target point from the current position of the robot, so the return-to-home start point and return-to-home end point can be preset by the user. By default, the starting point of the return home is the current position of the robot, and the end point of the return home can be set through the default home point (home) point, or the user can click to set it through the APP, or input it in the form of a configuration file, which is not limited here.
关于语义图修改About Semantic Graph Modification
语义图修改包括两种方式:用户在语义地图上框选多边形障碍物,或者由用户修改像素点的语义值。The semantic map modification includes two ways: the user selects polygonal obstacles on the semantic map, or the user modifies the semantic value of the pixel point.
进一步地,还可以由用户设定绕行障碍物信息。Further, the detour obstacle information can also be set by the user.
语义图信息虽然标注了不同物体的语义值,但是在规划的时候需要确定哪些语义值对应的图像区域需要进行绕行。例如,可以指定果树、建筑物、电线杆等语义值对应的图形区域为需要绕行的图形区域,而农田、路面、水面等对应的图形区域无需绕行。Although the semantic map information annotates the semantic values of different objects, it is necessary to determine which image areas corresponding to the semantic values need to be detoured during planning. For example, graphics areas corresponding to semantic values such as fruit trees, buildings, and utility poles can be designated as graphics areas that need to be detoured, while graphics areas corresponding to farmland, road surfaces, and water surfaces do not need to be detoured.
关于设定规划参数About Setting Planning Parameters
规划参数包括但不限于:机器人距离障碍物的最小安全距离、机器人运动限制参数、机器人飞行高度等。The planning parameters include but are not limited to: the minimum safe distance of the robot from the obstacle, the robot motion limit parameters, the robot flying height, etc.
二、关于算法规划部分2. About the algorithm planning part
首先,可以进行语义图障碍物轮廓提取。也可以基于语义地图的各像素进行移动路径规划。First, semantic map obstacle contour extraction can be performed. Movement path planning can also be performed based on each pixel of the semantic map.
其中,进行语义图障碍物轮廓提取是考虑到:语义地图中障碍物信息是通过一个一个像素点进行设定的,需要将一大堆的障碍物像素点聚合成一个多边形的轮廓,以便于提高后续的计算。需要说明的是,该操作并不是必须操作步骤,也可以直接在像素点上进行规划,只不过这种规划方式速度较慢(多次查询像素点语义值耗时较大)。例如,参考图14中各图形区域的轮廓。Among them, the extraction of the obstacle contour in the semantic map is based on the consideration that the obstacle information in the semantic map is set through a pixel point, and a large number of obstacle pixel points need to be aggregated into a polygonal outline in order to improve the subsequent calculations. It should be noted that this operation is not a necessary operation step, and it can also be planned directly on the pixel points, but this planning method is relatively slow (it takes a lot of time to query the semantic value of the pixel point multiple times). For example, refer to Figure 14 for the outlines of the graphic areas.
关于多种障碍物配置信息融合About the fusion of various obstacle configuration information
如上,障碍物除了语义图自带的像素点,本申请的实施例还支持用户直接在语义图上框选出多边形障碍物。框选的多边形信息可以不存储在语义图中,如通过配置文件的形式读取。本操作中形成的多边形障碍物的图形区域与上一操作中提取的障碍物轮廓融合在一起,使得所有的障碍物的图形区域都通过语义地图上的多边形图形区域进行表征。As above, in addition to the pixels in the semantic map, the embodiments of the present application also support the user to directly select polygonal obstacles on the semantic map. The box-selected polygon information may not be stored in the semantic map, such as read in the form of a configuration file. The graphic areas of the polygonal obstacles formed in this operation are fused with the contours of the obstacles extracted in the previous operation, so that all the graphic areas of the obstacles are represented by the polygonal graphic areas on the semantic map.
关于规划地图生成与返航路径规划About planning map generation and return path planning
在障碍物对应的图形区域,或者障碍物对应的图形区域、初始路径点、目标路径点确定后,运行路径规划算法,计算出一条安全的移动路径,该移动路径可以具有如下所示的特点:一方面,路径任何一处满足可移动平台到障碍物的最小距离(安全距离)。一方面,初始路径点到目标路径点的“耗费”最小,其中,耗费可通过不同的指标评价,例如距离最短、能量耗费最小。一方面,移动路径平滑,满足可移动平台(如无人机等)的机动要求。After the graphic area corresponding to the obstacle, or the graphic area corresponding to the obstacle, the initial path point, and the target path point are determined, run the path planning algorithm to calculate a safe moving path. The moving path can have the following characteristics: On the one hand, any part of the path satisfies the minimum distance (safety distance) from the movable platform to the obstacle. On the one hand, the "cost" from the initial waypoint to the target waypoint is the smallest, wherein the cost can be evaluated by different indicators, such as the shortest distance and the smallest energy cost. On the one hand, the moving path is smooth and meets the maneuvering requirements of movable platforms (such as drones, etc.).
关于输出移动路径About output movement paths
在规划算法执行结束后,还需要对路径做适当的格式处理,使其满足后期执行的要求,然后输出路径。After the execution of the planning algorithm, the path needs to be properly formatted to meet the requirements of the later execution, and then the path is output.
至此,整个基于语义图的规划过程结束。此外,还可以包括如下操作。At this point, the entire semantic graph-based planning process ends. In addition, the following operations may also be included.
三、关于飞行控制执行路径3. About the flight control execution path
在本实施例中,可移动平台可以基于上一操作中生成的返航的移动路径,并执行移动路径。In this embodiment, the movable platform may execute the movement path based on the return-to-home movement path generated in the previous operation.
在一个实施例中,还可以基于语义地图实现类似地理围栏的效果,便于给可移动平台操控者设置操作规范,降低可移动平台移动至禁行区的风险。In one embodiment, an effect similar to a geo-fence can also be achieved based on the semantic map, which facilitates setting operation specifications for the operator of the movable platform, and reduces the risk of the movable platform moving to a restricted area.
例如,在根据目标图像区域的语义信息对应的可移动平台的避障策略, 规划可移动平台避开目标图像区域对应的目标对象的移动路径之后,还包括如下操作。For example, after planning the moving path of the movable platform to avoid the target object corresponding to the target image area according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, the following operations are further included.
接收基于用户操作生成的控制杆量。如用户通过遥控器的控制杆来控制可移动平台的移动时,如果确定控制杆量会使得可移动平台进入与目标图像区域(如避障策略是绕行策略对应的图形区域),则不响应控制杆量。例如,在无人机飞行比赛中,可以通过语义地图设置封闭的禁飞区,或者在比赛场地中针对特定区域设置禁飞区,避免无人机操作不当对观众等造成伤害或参赛选手通过违规的方式进行比赛等。Receives joystick amounts generated based on user actions. For example, when the user controls the movement of the movable platform through the joystick of the remote control, if it is determined that the amount of the joystick will make the movable platform enter the target image area (for example, the obstacle avoidance strategy is the graphics area corresponding to the detour strategy), no response will be made. lever volume. For example, in a drone flying competition, a closed no-fly zone can be set up through a semantic map, or a no-fly zone can be set up for a specific area in the competition venue to prevent improper drone operation from causing damage to spectators or competitors passing the rules. way of playing the game, etc.
图17为本申请实施例提供的不响应控制杆量的示意图。FIG. 17 is a schematic diagram of a non-response control rod amount provided by an embodiment of the present application.
如图17所示,虚线为可移动平台的移动轨迹,外围网格区域被设置为语义信息是建筑物,内部还设置有禁飞区。如果用户的控制杆量会使得可移动平台会进入与建筑物对应的图形区域或与禁飞区对应的图形区域,则可移动平台会根据语义地图确定不响应该控制杆量。As shown in FIG. 17 , the dotted line is the movement track of the movable platform, the peripheral grid area is set as the semantic information is a building, and a no-fly zone is also set inside. If the user's lever amount would cause the movable platform to enter a graphics area corresponding to a building or a graphics area corresponding to a no-fly zone, the movable platform may determine, based on the semantic map, not to respond to the lever amount.
以下以无人机及其控制终端为例,对上述各操作的执行主体进行示例性说明。其中,无人机及其控制终端之间可以相互传输以下涉及的至少部分信息。The following takes the drone and its control terminal as an example to illustrate the execution subject of each of the above operations. Among them, the UAV and its control terminal can transmit at least part of the following information to each other.
可以由无人机和/或其控制终端获取可移动平台运行环境的语义地图。A semantic map of the operating environment of the mobile platform can be obtained by the UAV and/or its control terminal.
可以由无人机和/或其控制终端确定语义地图中目标图像区域的语义信息。The semantic information of the target image area in the semantic map can be determined by the UAV and/or its control terminal.
可以由无人机和/或其控制终端规划可移动平台避开目标图像区域对应的目标对象的移动路径。The moving path of the movable platform to avoid the target object corresponding to the target image area can be planned by the UAV and/or its control terminal.
可以由控制终端接收语义地图更新信息。The semantic map update information may be received by the control terminal.
可以由控制终端显示用户交互界面及多种与路径规划相关的信息。The user interface and various information related to path planning can be displayed by the control terminal.
可以由无人机通过传感器检测在飞行过程中的障碍物信息,以进行移动。The obstacle information during the flight can be detected by the drone through the sensor to move.
可以由无人机和/或其控制终端更新语义地图。The semantic map can be updated by the drone and/or its control terminal.
可以由控制终端接收用户操作,以生成控制杆量。User operations may be received by the control terminal to generate lever quantities.
需要说明的是,上述各操作的执行主体仅为示例性说明,不能理解为对本申请的限定,可以由可移动平台、控制终端、云台或负载其中的一个独立完成,或其中的几个配合完成。例如,对于可移动平台是陆地机器人的情形下,可以在陆地机器人上设置人机交互模块(如包括用于显示人机交互界面 的显示器等),用户可以直接在可移动平台展示的交互界面上获取用户操作,以获取地图更新信息等。其中,独立完成包括主动或被动地、直接或间接地从其它设备获取相应数据以执行相应操作It should be noted that the execution subject of each of the above operations is only an exemplary description, and should not be construed as a limitation of the present application. It may be independently completed by one of the movable platform, control terminal, PTZ or load, or several of them may cooperate with each other. Finish. For example, in the case where the movable platform is a land robot, a human-computer interaction module (such as a display for displaying a human-computer interaction interface, etc.) can be set on the land robot, and the user can directly display the interactive interface on the movable platform. Get user actions to get map update information, etc. Among them, independent completion includes actively or passively, directly or indirectly obtaining corresponding data from other devices to perform corresponding operations
本申请实施例提供的路径规划方法,基于语义地图提供的环境信息作为路径规划的至少部分依据,丰富了环境信息的来源,降低了对相关技术通过复杂的传感器感知环境信息的依赖。尤其是对于较稳定的环境,其语义地图可以复用,无需每次进行路径规划时都需要通过复杂的传感器感知环境信息以实时建图。此外,由于语义地图中包括的环境信息可编辑,使得用户可根据实际场景编辑环境信息,提高了其应用的灵活性。另外,由于语义地图是预先制作好的,减少了可移动平台作业时环境检测的计算量,有效降低了资源消耗。The path planning method provided by the embodiments of the present application uses the environmental information provided by the semantic map as at least part of the basis for path planning, which enriches the sources of environmental information and reduces the dependence on related technologies to perceive environmental information through complex sensors. Especially for a relatively stable environment, the semantic map can be reused, and there is no need to perceive the environment information through complex sensors to build the map in real time every time the path planning is performed. In addition, since the environmental information included in the semantic map can be edited, the user can edit the environmental information according to the actual scene, which improves the flexibility of its application. In addition, since the semantic map is pre-made, the calculation amount of the environment detection during the operation of the mobile platform is reduced, and the resource consumption is effectively reduced.
图18为本申请实施例提供的路径规划装置的结构示意图。FIG. 18 is a schematic structural diagram of a path planning apparatus provided by an embodiment of the present application.
如图18所示,该路径规划装置1800可以包括一个或多个处理器1810,该一个或多个处理器1810可以集成在一个处理单元中,也可以分别设置在多个处理单元中。计算机可读存储介质1820,用于存储一个或多个计算机程序1821,计算机程序在被处理器执行时,实现如上的路径规划方法,例如,获取第一用户指令;响应于第一用户指令,从辅助视场内确定至少一个基点;以及基于至少一个基点确定期望视场,以得到与期望视场相吻合的图像。As shown in FIG. 18 , the path planning apparatus 1800 may include one or more processors 1810, and the one or more processors 1810 may be integrated in one processing unit, or may be separately arranged in multiple processing units. The computer-readable storage medium 1820 is used to store one or more computer programs 1821. When the computer program is executed by the processor, the above path planning method is implemented, for example, obtaining a first user instruction; in response to the first user instruction, from Determining at least one base point within the auxiliary field of view; and determining a desired field of view based on the at least one base point to obtain an image conforming to the desired field of view.
其中,该路径规划装置1800可以被设置在一个执行主体中或分别设置在多个执行主体中。例如,对于可以实现本地控制功能的陆地机器人等的场景中,该路径规划装置1800可以被设置在该陆地机器人中,如该陆地机器人上设置有云台,云台上可以设置相机,陆地机器人的机体上设置有显示屏以便于与用户进行交互。又例如,对于可以使用非本地控制终端对可移动平台进行控制的场景中,该路径规划装置1800的至少部分可以被设置在控制终端中,如接受用户操作的相关功能被设置在控制终端中。该路径规划装置1800的至少部分可以被设置在可移动平台中,如信息传输功能、环境信息感测功能和联动控制功能等中至少一种。此外,该路径规划装置1800的至少部分可以被设置在负载中等。Wherein, the path planning apparatus 1800 may be set in one execution body or respectively set in multiple execution bodies. For example, in a scenario such as a land robot that can implement a local control function, the path planning device 1800 can be set in the land robot. A display screen is arranged on the body to facilitate interaction with the user. For another example, in a scenario where a non-local control terminal can be used to control the movable platform, at least part of the path planning apparatus 1800 can be set in the control terminal, such as the relevant functions of accepting user operations are set in the control terminal. At least a part of the path planning apparatus 1800 may be set in a movable platform, such as at least one of an information transmission function, an environmental information sensing function, and a linkage control function. Furthermore, at least a portion of the path planning apparatus 1800 may be placed under load or the like.
例如,处理单元可以包括现场可编程门阵列(Field-Programmable Gate Array,FPGA)或者一个或者多个ARM处理器。处理单元可以与非易失性计 算机可读存储介质1820连接。与非易失性计算机可读存储介质1820可以存储由处理单元所执行的逻辑、代码及/或者计算机指令,用于执行一个或者多个步骤。非易失性计算机可读存储介质1820可以包括一个或者多个存储单元(可去除的介质或者外部存储器,如SD卡或者RAM)。在某些实施例中,传感器感测的数据可以直接传送并存储到非易失性计算机可读存储介质1820的存储单元中。非易失性计算机可读存储介质1820的存储单元可以存储由处理单元所执行的逻辑、代码及/或者计算机指令,以执行本案描述的各种方法的各个实施例。例如,处理单元可以用于执行指令,以导致处理单元的一个或者多个处理器执行上述描述的追踪功能。存储单元可以存储感测模块感测数据,该数据感测由处理单元所处理。在某些实施例中,非易失性计算机可读存储介质1820的存储单元可以存储处理单元产生的处理结果。For example, the processing unit may comprise a Field-Programmable Gate Array (FPGA) or one or more ARM processors. The processing unit may be connected to non-volatile computer readable storage medium 1820. The non-volatile computer-readable storage medium 1820 may store logic, code, and/or computer instructions executed by the processing unit for performing one or more steps. The non-volatile computer-readable storage medium 1820 may include one or more storage units (removable media or external memory such as SD card or RAM). In some embodiments, the data sensed by the sensor may be transferred and stored directly into a storage unit of the non-volatile computer-readable storage medium 1820 . The storage units of the non-volatile computer-readable storage medium 1820 may store logic, code, and/or computer instructions executed by the processing unit to perform various embodiments of the various methods described herein. For example, a processing unit may be configured to execute instructions to cause one or more processors of the processing unit to perform the tracing functions described above. The storage unit may store sensing module sensing data, the data sensing being processed by the processing unit. In some embodiments, the storage unit of the non-volatile computer-readable storage medium 1820 may store processing results generated by the processing unit.
在某些实施例中,处理单元可以与控制模块连接,用以控制可移动平台的状态。例如,控制模块可以用于控制可移动平台的动力机构,以调整可移动平台相对于六个自由度的空间方位、速度及/或加速度。可选地或者相结合的,控制模块可以控制承载体,负载或者感测模块中的一个或者多个。In some embodiments, the processing unit may be connected to the control module for controlling the state of the movable platform. For example, the control module may be used to control the power mechanism of the movable platform to adjust the spatial orientation, velocity and/or acceleration of the movable platform relative to six degrees of freedom. Alternatively or in combination, the control module may control one or more of the carrier, load or sensing module.
处理单元还可以与通讯模块连接,用以与一个或者多个外围设备(如终端、显示设备、或者其它远程控制设备)传送及/或者接收数据。这里可以利用任何合适的通讯方法,如有线通讯或者无线通讯。例如,通讯模块可以利用到一个或者多个局域网、广域网、红外线、无线电、Wi-Fi、点对点(P2P)网络、电信网络、云网络等。可选地,可以用到中继站,如信号塔、卫星、或者移动基站等。The processing unit may also be connected to the communication module for transmitting and/or receiving data with one or more peripheral devices (eg, terminals, display devices, or other remote control devices). Any suitable communication method may be utilized here, such as wired communication or wireless communication. For example, the communication module may utilize one or more local area networks, wide area networks, infrared, radio, Wi-Fi, peer-to-peer (P2P) networks, telecommunication networks, cloud networks, and the like. Optionally, a relay station, such as a signal tower, a satellite, or a mobile base station, can be used.
上述各个部件之间可以是相互适配的。例如,一个或者多个部件位于可移动平台、承载体、负载、终端、感测系统、或者与前述各设备通讯的额外的外部设备上。在某些实施例中,处理单元及/或非易失性计算机可读介质中的一个或者多个可以位于不同的位置,如在可移动平台、承载体、负载、终端、感测系统、或者与前述各设备通讯的额外的外部设备以及前述的各种结合上。The above-mentioned various components may be compatible with each other. For example, one or more components are located on a movable platform, carrier, payload, terminal, sensing system, or additional external device in communication with each of the foregoing. In some embodiments, one or more of the processing unit and/or non-transitory computer-readable medium may be located in different locations, such as on a removable platform, carrier, payload, terminal, sensing system, or Additional external devices that communicate with the foregoing devices and various combinations of the foregoing.
此外,与可移动平台相适配的控制终端可以包括输入模块、处理单元、存储器、显示模块、以及通讯模块,所有这样的部件都是通过总线或者相似的网络相连接。Furthermore, the control terminal adapted to the movable platform may include an input module, a processing unit, a memory, a display module, and a communication module, all of which are connected by a bus or similar network.
输入模块包括一个或者多个输入机制,以获取用户通过操作该输入模块产生的输入。输入机制包括一个或者多个操纵杆、开关、旋钮、滑动开关、按钮、拨号盘、触摸屏、小键盘、键盘、鼠标、声音控制、手势控制、惯性模块等。输入模块可以用于获取用户的输入,该输入用于控制可移动平台、承载体、负载、或者其中部件的任何方面。任何方面包括姿态、位置、方向、飞行、追踪等。例如,输入机制可以是用户手动设置一个或者多个位置,每个位置对应一个预设输入,以控制可移动平台。The input module includes one or more input mechanisms to obtain input generated by the user by manipulating the input module. Input mechanisms include one or more joysticks, switches, knobs, slide switches, buttons, dials, touchscreens, keypads, keyboards, mice, voice controls, gesture controls, inertial modules, and the like. The input module may be used to obtain user input for controlling the movable platform, carrier, load, or any aspect of the components therein. Any aspect includes attitude, position, orientation, flight, tracking, etc. For example, the input mechanism may be that the user manually sets one or more positions, each position corresponding to a preset input, to control the movable platform.
在某些实施例中,输入机制可以由用户操作,以输入控制指令,控制可移动平台的运动。例如,用户可以利用旋钮、开关或者相似的输入机制,输入可移动平台的运动模式,如自动飞行、自动驾驶或者根据预设运动路径运动。又如,用户可以通过用某种方法倾斜控制终端,以控制可移动平台的位置、姿态、方向、或者其它方面。控制终端的倾斜可以由一个或者多个惯性传感器所侦测,并产生对应的运动指令。再如,用户可以利用上述输入机制调整负载的操作参数(如变焦)、负载的姿态(通过承载体),或者可移动平台上的任何物体的其它方面。In some embodiments, the input mechanism may be operated by a user to input control commands to control the movement of the movable platform. For example, a user can use a knob, switch, or similar input mechanism to input a motion mode of the movable platform, such as auto-flying, auto-pilot, or moving according to a preset motion path. For another example, the user can control the position, attitude, orientation, or other aspects of the movable platform by tilting the control terminal in a certain way. The tilt of the control terminal can be detected by one or more inertial sensors, and corresponding motion commands can be generated. As another example, the user may utilize the input mechanisms described above to adjust operational parameters of the payload (eg, zoom), the attitude of the payload (via the carrier), or other aspects of any object on the movable platform.
在某些实施例中,输入机制可以由用户操作,以输入前述描述目标物信息。例如,用户可以利用旋钮、开关或者相似的输入机制,选择合适的追踪模式,如人工追踪模式或者自动追踪模式。用户也可以利用该输入机制选择所要追踪的特定目标物、执行的目标物类型信息、或者其它相似的信息。在各种实施例中,输入模块可以由不止一个设备所执行。例如,输入模块可以由带有操纵杆的标准远程控制器所执行。带有操纵杆的标准远程控制器连接到运行适合应用程序(“APP”)的移动设备(如智能手机)中,以产生可移动平台的控制指令。APP可以用于获取用户的输入。In some embodiments, the input mechanism may be operated by the user to input the aforementioned descriptive object information. For example, the user may select an appropriate tracking mode, such as a manual tracking mode or an automatic tracking mode, using a knob, switch, or similar input mechanism. The user may also utilize this input mechanism to select a specific target to be tracked, target type information to execute, or other similar information. In various embodiments, the input module may be executed by more than one device. For example, the input module can be implemented by a standard remote controller with a joystick. A standard remote controller with a joystick connects to a mobile device (eg, a smartphone) running a suitable application ("APP") to generate control commands for the movable platform. APPs can be used to obtain user input.
处理单元可以与存储器连接。存储器包括易失性或者非易失性存储介质,用于存储数据,及/或处理单元可执行的逻辑、代码、及/或程序指令,用于执行一个或者多个规则或者功能。存储器可以包括一个或者多个存储单元(可去除的介质或者外部存储器,如SD卡或者RAM)。在某些实施例中,输入模块的数据可以直接传送并存储在存储器的存储单元中。存储器的存储单元可以存储由处理单元所执行的逻辑、代码及/或者计算机指令,以执行本案描述的各种方法的各个实施例。例如,处理单元可以用于执行指令,以导致处 理单元的一个或者多个处理器处理及显示从可移动平台获取的感应数据(如影像),基于用户输入产生的控制指令,包括运动指令及目标物信息,并导致通讯模块传送及/或者接收数据等。存储单元可以存储感测数据或者从外部设备(如可移动平台)接收的其它数据。在某些实施例中,存储器的存储单元可以存储处理单元生成的处理结果。The processing unit may be connected to the memory. Memory includes volatile or non-volatile storage media for storing data, and/or logic, code, and/or program instructions executable by a processing unit for performing one or more rules or functions. The memory may include one or more storage units (removable media or external memory such as SD card or RAM). In some embodiments, the data input to the module may be directly transferred and stored in a storage unit of the memory. The storage units of the memory may store logic, code and/or computer instructions executed by the processing unit to perform various embodiments of the various methods described herein. For example, the processing unit may be configured to execute instructions to cause one or more processors of the processing unit to process and display sensory data (eg, images) obtained from the movable platform, control commands generated based on user input, including motion commands and objects information, and cause the communication module to transmit and/or receive data, etc. The storage unit may store sensed data or other data received from an external device such as a removable platform. In some embodiments, the storage unit of the memory may store the processing result generated by the processing unit.
在某些实施例中,显示模块可以用于显示如图2中可移动平台10、承载体13及/或作业设备14关于位置、平移速度、平移加速度、方向、角速度、角加速度、或者其结合等的信息。显示模块可以用于获取可移动平台及/或者负载发送的信息,如感测数据(相机或者其它影像捕获设备记录的影像)、所描述的追踪数据、控制反馈数据等。在某些实施例中,显示模块可以与输入模块由相同的设备所执行。在其它实施例中,显示模块与输入模块可以由不相同的设备所执行。In some embodiments, the display module may be used to display the position, translation velocity, translation acceleration, orientation, angular velocity, angular acceleration, or a combination thereof of the movable platform 10, the carrier 13 and/or the working equipment 14 as shown in FIG. 2 . etc. information. The display module can be used to obtain information sent by the movable platform and/or payload, such as sensory data (images recorded by cameras or other image capture devices), described tracking data, control feedback data, and the like. In some embodiments, the display module may be executed by the same device as the input module. In other embodiments, the display module and the input module may be executed by different devices.
通讯模块可以用于从一个或者多个远程设备(如可移动平台、承载体、基站等)传送及/或者接收数据。例如,通讯模块可以传送控制信号(如运动信号、目标物信息、追踪控制指令)给外围系统或者设备,如图2中可移动平台10、承载体13及/或测绘装置。通讯模块可以包括传送器及接收器,分别用于从远程设备接收数据以及传送数据给远程设备。在某些实施例中,通讯模块可以包括收发器,其结合了传送器与接收器的功能。在某些实施例中,传送器与接收器之间以及与处理单元之间可以彼此通讯。通讯可以利用任何合适的通讯手段,如有线通讯或者无线通讯。The communication module may be used to transmit and/or receive data from one or more remote devices (eg, removable platforms, carriers, base stations, etc.). For example, the communication module can transmit control signals (such as motion signals, target information, and tracking control commands) to peripheral systems or devices, such as the movable platform 10 , the carrier 13 and/or the surveying and mapping device in FIG. 2 . The communication module may include a transmitter and a receiver for receiving data from and transmitting data to the remote device, respectively. In some embodiments, the communication module may include a transceiver that combines the functions of a transmitter and a receiver. In some embodiments, the transmitter and receiver and the processing unit may communicate with each other. Communication may utilize any suitable means of communication, such as wired or wireless communication.
可移动平台在运动过程中捕获的影像可以从可移动平台或者影像设备传回给控制终端或者其它适合的设备,以显示、播放、存储、编辑或者其它目的。这样的传送可以是当影像设备捕获影像时,实时的或者将近实时的发生。可选地,影像的捕获及传送之间可以有延迟。在某些实施例中,影像可以存储在可移动平台的存储器中,而不用传送到任何其它地方。用户可以实时看到这些影像,如果需要,调整目标物信息或者调整可移动平台或者其部件的其它方面。调整的目标物信息可以提供给可移动平台,重复的过程可能继续直到获得可想要的影像。在某些实施例中,影像可以从可移动平台、影像设备及/或控制终端传送给远程服务器。例如,影像可以在一些社交网络平台,如微信朋友圈或者微博上以进行分享。Images captured by the movable platform during motion can be transmitted from the movable platform or imaging device back to a control terminal or other suitable device for display, playback, storage, editing, or other purposes. Such transmission may occur in real-time or near real-time as the imaging device captures the imagery. Optionally, there may be a delay between the capture and transmission of the imagery. In some embodiments, the imagery may be stored in the removable platform's memory without being transferred anywhere else. The user can view these images in real time and, if necessary, adjust target information or other aspects of the movable platform or its components. Adjusted object information may be provided to the movable platform, and the iterative process may continue until the desired image is obtained. In some embodiments, the imagery may be transmitted to a remote server from the removable platform, the imagery device, and/or the control terminal. For example, images can be shared on some social networking platforms, such as WeChat Moments or Weibo.
在一个实施例中,根据语义地图,确定语义地图中目标图像区域的语义信息可以包括如下操作。In one embodiment, according to the semantic map, determining the semantic information of the target image region in the semantic map may include the following operations.
首先,根据可移动平台的初始路径点和目标路径点在语义地图中对应的位置信息以及语义地图,确定目标图像区域。First, the target image area is determined according to the corresponding position information of the initial waypoint of the movable platform and the target waypoint in the semantic map and the semantic map.
然后,根据目标图像区域,确定目标图像区域的语义信息。Then, according to the target image area, the semantic information of the target image area is determined.
具体内容参考前面的实施例的相同部分,此处不再做赘述。For the specific content, refer to the same part of the previous embodiment, which will not be repeated here.
在一个实施例中,可移动平台的初始路径点是返航起点,可移动平台的目标路径点是返航终点。In one embodiment, the initial waypoint of the movable platform is the start point of the return home, and the target waypoint of the movable platform is the end point of the return home.
在一个实施例中,根据语义地图,确定语义地图中目标图像区域的语义信息,包括:根据可移动平台在语义地图中对应的位置信息以及语义地图,确定目标图像区域;根据目标图像区域,确定目标图像区域的语义信息。In one embodiment, determining the semantic information of the target image area in the semantic map according to the semantic map includes: determining the target image area according to the corresponding position information of the movable platform in the semantic map and the semantic map; determining the target image area according to the target image area; Semantic information of the target image region.
在一个实施例中,在获取可移动平台运行环境的语义地图之前,上述方法还可以包括:获取可移动平台运行环境的初始语义地图;获取基于用户操作生成的语义地图更新信息;根据语义地图更新信息更新初始语义地图,以得到可移动平台运行环境的语义地图。In one embodiment, before acquiring the semantic map of the mobile platform operating environment, the above method may further include: acquiring an initial semantic map of the mobile platform operating environment; acquiring semantic map update information generated based on user operations; updating according to the semantic map The information updates the initial semantic map to obtain the semantic map of the operating environment of the mobile platform.
在一个实施例中,上述方法还包括:提供用户交互界面,在用户交互界面上显示初始语义地图。相应地,获取基于用户操作生成的语义地图更新信息,包括:获取基于用户在用户交互界面上的操作生成的语义地图更新信息。In one embodiment, the above method further includes: providing a user interaction interface, and displaying the initial semantic map on the user interaction interface. Correspondingly, acquiring the semantic map update information generated based on the user operation includes: acquiring the semantic map update information generated based on the user's operation on the user interaction interface.
在一个实施例中,语义地图更新信息包括语义地图中更新的图像区域的位置、形状和语义信息。In one embodiment, the semantic map update information includes location, shape, and semantic information of the updated image region in the semantic map.
在一个实施例中,语义地图更新信息还包括语义地图中更新的图像区域的语义信息对应的避障策略。In one embodiment, the semantic map update information further includes an obstacle avoidance strategy corresponding to the semantic information of the updated image area in the semantic map.
在一个实施例中,语义地图更新信息包括初始语义地图中的图像区域的语义信息对应的避障策略。In one embodiment, the semantic map update information includes an obstacle avoidance strategy corresponding to the semantic information of the image region in the initial semantic map.
在一个实施例中,避障策略包括:侧面绕行策略、上方通过策略或下方通过策略中至少一种。In one embodiment, the obstacle avoidance strategy includes at least one of a side detour strategy, an upper pass strategy, or a downward pass strategy.
在一个实施例中,侧面绕行策略包括:当目标对象的尺寸满足预设条件时,采用第一侧面绕行策略进行侧面绕行,当目标对象的尺寸不满足预设条件时,采用第二侧面绕行策略进行侧面绕行。In one embodiment, the side detour strategy includes: when the size of the target object satisfies the preset condition, adopting the first side detour strategy to perform the side detour, and when the size of the target object does not meet the preset condition, adopting the second detour strategy The side detour strategy performs a side detour.
在一个实施例中,移动路径为弓字型路径,弓字型路径包括作业路径和横移路径,目标对象的尺寸是在垂直于作业路径的方向上目标对象的尺寸。In one embodiment, the moving path is a bow-shaped path, the bow-shaped path includes a work path and a traverse path, and the size of the target object is the size of the target object in a direction perpendicular to the work path.
在一个实施例中,移动路径为弓字型路径,弓字型路径包括作业路径和横移路径,目标对象的尺寸是在垂直于作业路径的方向上目标对象的尺寸。In one embodiment, the moving path is a bow-shaped path, the bow-shaped path includes a work path and a traverse path, and the size of the target object is the size of the target object in a direction perpendicular to the work path.
在一个实施例中,通过比较目标对象的尺寸和可移动平台的作业路径间距确定目标对象的尺寸是否满足预设条件。In one embodiment, whether the size of the target object satisfies a preset condition is determined by comparing the size of the target object with the working path distance of the movable platform.
在一个实施例中,第一侧面绕行策略包括:移动至相邻的作业路径。第二侧面绕行策略包括:从侧边绕行以继续当前的作业路径。In one embodiment, the first side detour strategy includes moving to an adjacent work path. The second side detour strategy includes detouring from the side to continue the current work path.
在一个实施例中,当避障策略包括上方通过时,设置可移动平台的作业状态为禁止作业。In one embodiment, when the obstacle avoidance strategy includes passing over, the operation status of the movable platform is set to prohibit operation.
在一个实施例中,避障策略还包括安全距离信息,安全距离信息用于指示可移动平台相对于目标图像区域对应的目标对象的最小间距。In one embodiment, the obstacle avoidance strategy further includes safety distance information, where the safety distance information is used to indicate the minimum distance between the movable platform and the target object corresponding to the target image area.
在一个实施例中,安全距离与以下至少一种相关:可移动平台的尺寸、可移动平台的作业半径。In one embodiment, the safety distance is related to at least one of: the size of the movable platform, the working radius of the movable platform.
在一个实施例中,获取目标图像区域对应的高程信息。相应地,根据目标图像区域的语义信息对应的可移动平台的避障策略,规划可移动平台避开目标图像区域对应的目标对象的移动路径,包括:根据目标图像区域的语义信息对应的可移动平台的避障策略以及目标图像区域对应的高程信息,规划可移动平台避开目标图像区域对应的目标对象的移动路径。In one embodiment, the elevation information corresponding to the target image area is acquired. Correspondingly, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, planning the moving path of the movable platform to avoid the target object corresponding to the target image area, including: according to the semantic information of the target image area corresponding to the movable platform The platform's obstacle avoidance strategy and the elevation information corresponding to the target image area are used to plan the moving path of the movable platform to avoid the target object corresponding to the target image area.
在一个实施例中,根据目标图像区域的语义信息对应的可移动平台的避障策略以及目标图像区域对应的高程信息,规划可移动平台避开目标图像区域对应的目标对象的移动路径,包括:当避障策略包括上方通过时,根据目标图像区域的语义信息对应的可移动平台的避障策略以及目标图像区域对应的高程信息,规划可移动平台避开目标图像区域对应的目标对象的移动路径。In one embodiment, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area and the elevation information corresponding to the target image area, planning the moving path of the movable platform to avoid the target object corresponding to the target image area, including: When the obstacle avoidance strategy includes passing above, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area and the elevation information corresponding to the target image area, plan the moving path of the movable platform to avoid the target object corresponding to the target image area .
在一个实施例中,在根据目标图像区域的语义信息对应的可移动平台的避障策略,规划可移动平台避开目标图像区域对应的目标对象的移动路径之后,该方法还包括:控制可移动平台基于移动路径和可移动平台通过传感器检测到的障碍物信息进行移动。In one embodiment, after planning the moving path of the movable platform to avoid the target object corresponding to the target image area according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, the method further includes: controlling the movable platform The platform moves based on the moving path and the obstacle information detected by the movable platform through the sensor.
在一个实施例中,可移动平台是无人机,在控制可移动平台基于移动路径和可移动平台通过传感器检测到的障碍物信息进行移动的过程中,对于无 人机检测到的障碍物,无人机从障碍物的上方通过的第一优先级高于从障碍物的下方通过的第二优先级。In one embodiment, the movable platform is an unmanned aerial vehicle, and in the process of controlling the movable platform to move based on the moving path and the obstacle information detected by the movable platform through the sensor, for the obstacles detected by the unmanned aerial vehicle, The first priority for the drone to pass above the obstacle is higher than the second priority for the drone to pass below the obstacle.
在一个实施例中,基于可移动平台检测到的障碍物更新语义地图。In one embodiment, the semantic map is updated based on obstacles detected by the movable platform.
在一个实施例中,控制可移动平台基于移动路径和可移动平台通过传感器检测到的障碍物信息进行移动,包括:在传感器检测到的障碍物的置信度大于预设阈值时,控制可移动平台基于移动路径和可移动平台通过传感器检测到的障碍物信息进行移动,障碍物的置信度与重复检测到障碍物的次数以及检测到障碍物时的环境信息相关。In one embodiment, controlling the movable platform to move based on the moving path and information of obstacles detected by the movable platform through the sensor includes: when the confidence of the obstacle detected by the sensor is greater than a preset threshold, controlling the movable platform Based on the moving path and the obstacle information detected by the mobile platform through the sensor, the confidence of the obstacle is related to the number of times the obstacle is repeatedly detected and the environmental information when the obstacle is detected.
在一个实施例中,提取语义地图的各区域的轮廓,以便至少基于目标图像区域的轮廓生成移动路径。In one embodiment, the contours of regions of the semantic map are extracted to generate movement paths based at least on the contours of the target image region.
在一个实施例中,移动路径满足以下至少一种条件:移动路径上的路径点与目标对象之间的距离大于安全距离;可移动平台从移动路径的初始路径点移动至目标路径点的资源消耗最优,资源包括以下至少一种:路径长度、能量或时间;以及移动路径的平滑度满足可移动平台的机动要求。In one embodiment, the movement path satisfies at least one of the following conditions: the distance between the waypoint on the movement path and the target object is greater than the safety distance; the resource consumption of the movable platform moving from the initial waypoint of the movement path to the target waypoint Optimally, the resources include at least one of the following: path length, energy or time; and the smoothness of the moving path meets the maneuvering requirements of the movable platform.
在一个实施例中,根据目标图像区域的语义信息对应的可移动平台的避障策略,规划可移动平台避开目标图像区域对应的目标对象的移动路径包括:根据目标图像区域的三维位置信息和避障策略建立目标函数;优化目标函数以确定可移动平台避开目标对象的移动路径。In one embodiment, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, planning the moving path of the movable platform to avoid the target object corresponding to the target image area includes: according to the three-dimensional position information of the target image area and The obstacle avoidance strategy establishes the objective function; the objective function is optimized to determine the moving path of the movable platform to avoid the target object.
在一个实施例中,在根据目标图像区域的语义信息对应的可移动平台的避障策略,规划可移动平台避开目标图像区域对应的目标对象的移动路径之后,还包括:接收基于用户操作生成的控制杆量;如果确定控制杆量指示可移动平台进入与目标图像区域,则不响应控制杆量。In one embodiment, after planning the moving path of the movable platform to avoid the target object corresponding to the target image area according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, the method further includes: receiving a generated image generated based on a user operation. The joystick amount of ; if the joystick amount is determined to indicate that the movable platform enters the target image area, the joystick amount is not responded to.
具体内容参考前面的实施例的相同部分,此处不再做赘述。For the specific content, refer to the same part of the previous embodiment, which will not be repeated here.
本申请的另一方面还提供了一种路径规划系统,用于规划移动路径,其中,系统包括:相互通信连接的控制终端和可移动平台,其中:控制终端和/或可移动平台包括如上的路径规划装置。Another aspect of the present application also provides a path planning system for planning a moving path, wherein the system includes: a control terminal and a movable platform that are communicatively connected to each other, wherein: the control terminal and/or the movable platform include the above Path planning device.
例如,可移动平台具体可以是农业无人机或农业无人车等。For example, the movable platform may specifically be an agricultural drone or an agricultural unmanned vehicle.
以上为本申请的最优实施例,需要说明的,该最优的实施例仅用于理解本申请,并不用于限制本申请的保护范围。并且,最优实施例中的特征,在 无特别注明的情况下,均同时适用于方法实施例和装置实施例,在相同或不同实施例中出现的技术特征在不相互冲突的情况下可以组合使用。The above are the best embodiments of the application, and it should be noted that the best embodiments are only used to understand the application, and are not used to limit the protection scope of the application. In addition, the features in the preferred embodiment, unless otherwise specified, are applicable to both the method embodiment and the device embodiment, and the technical features appearing in the same or different embodiments can be used without conflicting with each other. used in combination.
在一些可能的实施例中,最后应说明的是:以上实施方式仅用以说明本申请的技术方案,而非对其进行限制;尽管参照前述实施方式对本申请已经进行了详细的说明,但本领域的普通技术人员应当理解:其依然可以对前述实施方式所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请实施方式技术方案的范围。In some possible embodiments, it should be noted at the end that: the above embodiments are only used to illustrate the technical solutions of the present application, but not to limit them; although the present application has been described in detail with reference to the above embodiments, this Those of ordinary skill in the art should understand that: they can still make modifications to the technical solutions described in the foregoing embodiments, or perform equivalent replacements on some or all of the technical features; and these modifications or replacements do not make the essence of the corresponding technical solutions depart from The scope of the technical solutions of the embodiments of the present application.

Claims (56)

  1. 一种路径规划方法,用于规划可移动平台的移动路径,其特征在于,所述方法包括:A path planning method for planning a moving path of a movable platform, characterized in that the method comprises:
    获取所述可移动平台运行环境的语义地图,所述语义地图中各个图像区域的语义信息与所述可移动平台的避障策略具有对应关系;acquiring a semantic map of the operating environment of the movable platform, where the semantic information of each image area in the semantic map has a corresponding relationship with the obstacle avoidance strategy of the movable platform;
    根据所述语义地图,确定所述语义地图中目标图像区域的语义信息;According to the semantic map, determine the semantic information of the target image area in the semantic map;
    根据所述目标图像区域的语义信息对应的可移动平台的避障策略,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径。According to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, a moving path for the movable platform to avoid the target object corresponding to the target image area is planned.
  2. 根据权利要求1所述的方法,其特征在于,所述根据所述语义地图,确定所述语义地图中目标图像区域的语义信息,包括:The method according to claim 1, wherein the determining, according to the semantic map, the semantic information of the target image area in the semantic map comprises:
    根据所述可移动平台的初始路径点和目标路径点在所述语义地图中对应的位置信息以及所述语义地图,确定所述目标图像区域;Determine the target image area according to the corresponding position information of the initial waypoint of the movable platform and the target waypoint in the semantic map and the semantic map;
    根据所述目标图像区域,确定所述目标图像区域的语义信息。According to the target image area, the semantic information of the target image area is determined.
  3. 根据权利要求2所述的方法,所述可移动平台的初始路径点是返航起点,所述可移动平台的目标路径点是返航终点。The method according to claim 2, wherein the initial waypoint of the movable platform is a return-to-home origin, and the target waypoint of the movable platform is a return-to-home end point.
  4. 根据权利要求1所述的方法,其特征在于,所述根据所述语义地图,确定所述语义地图中目标图像区域的语义信息,包括:The method according to claim 1, wherein the determining, according to the semantic map, the semantic information of the target image area in the semantic map comprises:
    根据所述可移动平台在所述语义地图中对应的位置信息以及所述语义地图,确定所述目标图像区域;Determine the target image area according to the corresponding position information of the movable platform in the semantic map and the semantic map;
    根据所述目标图像区域,确定所述目标图像区域的语义信息。According to the target image area, the semantic information of the target image area is determined.
  5. 根据权利要求1所述的方法,其特征在于,在所述获取所述可移动平台运行环境的语义地图之前,还包括:The method according to claim 1, wherein before the acquiring the semantic map of the mobile platform operating environment, the method further comprises:
    获取所述可移动平台运行环境的初始语义地图;obtaining an initial semantic map of the mobile platform operating environment;
    获取基于用户操作生成的语义地图更新信息;Obtain semantic map update information generated based on user operations;
    根据所述语义地图更新信息更新所述初始语义地图,以得到所述可移动平台运行环境的语义地图。The initial semantic map is updated according to the semantic map update information, so as to obtain the semantic map of the operating environment of the mobile platform.
  6. 根据权利要求5所述的方法,其特征在于,所述方法还包括:The method according to claim 5, wherein the method further comprises:
    提供用户交互界面,在所述用户交互界面上显示所述初始语义地图;providing a user interaction interface on which the initial semantic map is displayed;
    所述获取基于用户操作生成的语义地图更新信息,包括:The acquiring semantic map update information generated based on user operations includes:
    获取基于用户在所述用户交互界面上的操作生成的语义地图更新信息。Obtain semantic map update information generated based on the user's operation on the user interface.
  7. 根据权利要求5所述的方法,其特征在于,所述语义地图更新信息包括所述语义地图中更新的图像区域的位置、形状和语义信息。The method according to claim 5, wherein the semantic map update information includes position, shape and semantic information of the updated image area in the semantic map.
  8. 根据权利要求5所述的方法,其特征在于,所述语义地图更新信息还包括所述语义地图中更新的图像区域的语义信息对应的避障策略。The method according to claim 5, wherein the semantic map update information further comprises an obstacle avoidance strategy corresponding to the semantic information of the updated image area in the semantic map.
  9. 根据权利要求5所述的方法,其特征在于,所述语义地图更新信息包括所述初始语义地图中的图像区域的语义信息对应的避障策略。The method according to claim 5, wherein the semantic map update information includes an obstacle avoidance strategy corresponding to the semantic information of the image region in the initial semantic map.
  10. 根据权利要求1所述的方法,其特征在于,所述避障策略包括:侧面绕行策略、上方通过策略或下方通过策略中至少一种。The method according to claim 1, wherein the obstacle avoidance strategy includes at least one of a side detour strategy, an upper pass strategy, or a downward pass strategy.
  11. 根据权利要求10所述的方法,其特征在于,所述侧面绕行策略包括:The method of claim 10, wherein the side detour strategy comprises:
    当所述目标对象的尺寸满足预设条件时,采用第一侧面绕行策略进行侧面绕行,当所述目标对象的尺寸不满足所述预设条件时,采用第二侧面绕行策略进行侧面绕行。When the size of the target object satisfies the preset condition, the first side detour strategy is adopted to perform side detour, and when the size of the target object does not meet the preset condition, the second side detour strategy is adopted to perform side detour bypass.
  12. 根据权利要求11所述的方法,其特征在于,所述移动路径为弓字型路径,所述弓字型路径包括作业路径和横移路径,所述目标对象的尺寸是在垂直于所述作业路径的方向上所述目标对象的尺寸。The method according to claim 11, wherein the moving path is a bow-shaped path, the bow-shaped path includes a work path and a traverse path, and the size of the target object is perpendicular to the work path. The size of the target object in the direction of the path.
  13. 根据权利要求12所述的方法,其特征在于,还包括:The method of claim 12, further comprising:
    通过比较所述目标对象的尺寸和所述作业路径的间距确定所述目标对象的尺寸是否满足所述预设条件。Whether the size of the target object satisfies the preset condition is determined by comparing the size of the target object with the distance between the working paths.
  14. 根据权利要求12所述的方法,其特征在于:The method of claim 12, wherein:
    所述第一侧面绕行策略包括:移动至相邻的作业路径;The first side detour strategy includes: moving to an adjacent working path;
    所述第二侧面绕行策略包括:从侧边绕行以继续当前的作业路径。The second side detour strategy includes detouring from the side to continue the current working path.
  15. 根据权利要求1所述的方法,其特征在于,还包括:The method of claim 1, further comprising:
    当所述避障策略包括上方通过时,设置所述可移动平台的作业状态为禁止作业。When the obstacle avoidance strategy includes passing above, the operation state of the movable platform is set to prohibit operation.
  16. 根据权利要求1所述的方法,其特征在于,所述避障策略还包括安全距离信息,所述安全距离信息用于指示所述可移动平台相对于所述目标图像区域对应的目标对象的最小间距。The method according to claim 1, wherein the obstacle avoidance strategy further comprises safety distance information, and the safety distance information is used to indicate the minimum distance of the movable platform relative to the target object corresponding to the target image area. spacing.
  17. 根据权利要求16所述的方法,其特征在于,所述安全距离与以下至少一种相关:可移动平台的尺寸、可移动平台的作业半径。The method of claim 16, wherein the safety distance is related to at least one of the following: the size of the movable platform and the working radius of the movable platform.
  18. 根据权利要求1所述的方法,其特征在于,还包括:The method of claim 1, further comprising:
    获取所述目标图像区域对应的高程信息;obtaining the elevation information corresponding to the target image area;
    所述根据所述目标图像区域的语义信息对应的可移动平台的避障策略,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径,包括:According to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, planning the moving path of the movable platform to avoid the target object corresponding to the target image area, including:
    根据所述目标图像区域的语义信息对应的可移动平台的避障策略以及所述目标图像区域对应的高程信息,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径。According to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area and the elevation information corresponding to the target image area, the moving path of the movable platform to avoid the target object corresponding to the target image area is planned.
  19. 根据权利要求18所述的方法,其特征在于,所述根据所述目标图像区域的语义信息对应的可移动平台的避障策略以及所述目标图像区域对应的高程信息,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径,包括:The method according to claim 18, wherein the movable platform is planned according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area and the elevation information corresponding to the target image area Avoiding the moving path of the target object corresponding to the target image area, including:
    当所述避障策略包括上方通过时,根据所述目标图像区域的语义信息对应的可移动平台的避障策略以及所述目标图像区域对应的高程信息,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径。When the obstacle avoidance strategy includes passing above, plan the movable platform to avoid the obstacle according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area and the elevation information corresponding to the target image area The moving path of the target object corresponding to the target image area.
  20. 根据权利要求1所述的方法,其特征在于,在所述根据所述目标图像区域的语义信息对应的可移动平台的避障策略,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径之后,还包括:The method according to claim 1, wherein in the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, the movable platform is planned to avoid the obstacle corresponding to the target image area. After the movement path of the target object, it also includes:
    控制所述可移动平台基于所述移动路径和所述可移动平台通过传感器检测到的障碍物信息进行移动。The movable platform is controlled to move based on the movement path and the obstacle information detected by the movable platform through the sensor.
  21. 根据权利要求20所述的方法,其特征在于,所述可移动平台是无人机,在控制所述可移动平台基于所述移动路径和所述可移动平台通过传感器检测到的障碍物信息进行移动的过程中,对于所述无人机检测到的障碍物,所述无人机从所述障碍物的上方通过的第一优先级高于从所述障碍物的下方通过的第二优先级。The method according to claim 20, wherein the movable platform is an unmanned aerial vehicle, and the control of the movable platform is based on the moving path and the obstacle information detected by the movable platform through sensors. During the movement, for the obstacle detected by the drone, the first priority of the drone passing above the obstacle is higher than the second priority passing below the obstacle .
  22. 根据权利要求20所述的方法,其特征在于,还包括:基于所述可移动平台检测到的障碍物更新所述语义地图。21. The method of claim 20, further comprising: updating the semantic map based on obstacles detected by the movable platform.
  23. 根据权利要求20所述的方法,其特征在于,所述控制所述可移动平台基于所述移动路径和所述可移动平台通过传感器检测到的障碍物信息进行移动,包括:The method according to claim 20, wherein the controlling the movable platform to move based on the movement path and information of obstacles detected by the movable platform through sensors comprises:
    在所述传感器检测到的障碍物的置信度大于预设阈值时,控制所述可移动平台基于所述移动路径和所述可移动平台通过传感器检测到的障碍物信息进行移动,所述障碍物的置信度与重复检测到所述障碍物的次数以及检测到所述障碍物时的环境信息相关。When the confidence of the obstacle detected by the sensor is greater than a preset threshold, the movable platform is controlled to move based on the movement path and the obstacle information detected by the movable platform through the sensor, the obstacle The confidence of is related to the number of times the obstacle is repeatedly detected and the environmental information when the obstacle is detected.
  24. 根据权利要求1所述的方法,其特征在于,还包括:提取所述语义地图的各区域的轮廓,以便至少基于所述目标图像区域的轮廓生成所述移动路径。The method according to claim 1, further comprising: extracting the outline of each area of the semantic map, so as to generate the movement path based on at least the outline of the target image area.
  25. 根据权利要求1所述的方法,其特征在于,所述移动路径满足以下至少一种条件:The method according to claim 1, wherein the movement path satisfies at least one of the following conditions:
    所述移动路径上的路径点与所述目标对象之间的距离大于安全距离;The distance between the path point on the moving path and the target object is greater than the safety distance;
    所述可移动平台从所述移动路径的初始路径点移动至目标路径点的资源消耗最优,所述资源包括以下至少一种:路径长度、能量或时间;以及The resource consumption of the movable platform moving from the initial waypoint of the movement path to the target waypoint is optimal, and the resource includes at least one of the following: path length, energy or time; and
    移动路径的平滑度满足可移动平台的机动要求。The smoothness of the moving path meets the maneuvering requirements of the movable platform.
  26. 根据权利要求1所述的方法,其特征在于,所述根据所述目标图像区域的语义信息对应的可移动平台的避障策略,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径包括:The method according to claim 1, wherein, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, the movable platform is planned to avoid the target corresponding to the target image area The movement path of the object includes:
    根据所述目标图像区域的三维位置信息和所述避障策略建立目标函数;establishing an objective function according to the three-dimensional position information of the target image area and the obstacle avoidance strategy;
    优化所述目标函数以确定所述可移动平台避开所述目标对象的移动路径。The objective function is optimized to determine a path of movement of the movable platform to avoid the target object.
  27. 根据权利要求1~26任一项所述的方法,其特征在于,在所述根据所述目标图像区域的语义信息对应的可移动平台的避障策略,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径之后,还包括:The method according to any one of claims 1 to 26, wherein in the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, the movable platform is planned to avoid the After the moving path of the target object corresponding to the target image area, it also includes:
    接收基于用户操作生成的控制杆量;Receive joystick amounts generated based on user actions;
    如果确定所述控制杆量指示所述可移动平台进入与所述目标图像区域,则不响应所述控制杆量。If it is determined that the lever amount indicates that the movable platform enters the target image area, the lever amount is not responded to.
  28. 一种路径规划装置,用于规划可移动平台的移动路径,其特征在于,所述装置包括:A path planning device for planning a moving path of a movable platform, characterized in that the device comprises:
    一个或多个处理器;以及one or more processors; and
    计算机可读存储介质,用于存储一个或多个计算机程序,所述计算机程序在被所述处理器执行时,实现:A computer-readable storage medium for storing one or more computer programs that, when executed by the processor, implement:
    获取所述可移动平台运行环境的语义地图,所述语义地图中各个图像区域的语义信息与所述可移动平台的避障策略具有对应关系;acquiring a semantic map of the operating environment of the movable platform, where the semantic information of each image area in the semantic map has a corresponding relationship with the obstacle avoidance strategy of the movable platform;
    根据所述语义地图,确定所述语义地图中目标图像区域的语义信息;以及According to the semantic map, determine the semantic information of the target image area in the semantic map; and
    根据所述目标图像区域的语义信息对应的可移动平台的避障策略,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径。According to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, a moving path for the movable platform to avoid the target object corresponding to the target image area is planned.
  29. 根据权利要求28所述的装置,其特征在于,所述根据所述语义地图,确定所述语义地图中目标图像区域的语义信息,包括:The device according to claim 28, wherein the determining, according to the semantic map, the semantic information of the target image area in the semantic map comprises:
    根据所述可移动平台的初始路径点和目标路径点在所述语义地图中对应的位置信息以及所述语义地图,确定所述目标图像区域;Determine the target image area according to the position information corresponding to the initial waypoint of the movable platform and the target waypoint in the semantic map and the semantic map;
    根据所述目标图像区域,确定所述目标图像区域的语义信息。According to the target image area, the semantic information of the target image area is determined.
  30. 根据权利要求29所述的装置,其特征在于,所述可移动平台的初始路径点是返航起点,所述可移动平台的目标路径点是返航终点。The device according to claim 29, wherein the initial waypoint of the movable platform is the starting point of the return home, and the target waypoint of the movable platform is the return home end point.
  31. 根据权利要求28所述的装置,其特征在于,所述根据所述语义地图,确定所述语义地图中目标图像区域的语义信息,包括:The device according to claim 28, wherein the determining, according to the semantic map, the semantic information of the target image area in the semantic map comprises:
    根据所述可移动平台在所述语义地图中对应的位置信息以及所述语义地图,确定所述目标图像区域;Determine the target image area according to the corresponding position information of the movable platform in the semantic map and the semantic map;
    根据所述目标图像区域,确定所述目标图像区域的语义信息。According to the target image area, the semantic information of the target image area is determined.
  32. 根据权利要求28所述的装置,其特征在于,在所述获取所述可移动平台运行环境的语义地图之前,还包括:The apparatus according to claim 28, wherein before the acquiring the semantic map of the mobile platform operating environment, the method further comprises:
    获取所述可移动平台运行环境的初始语义地图;obtaining an initial semantic map of the mobile platform operating environment;
    获取基于用户操作生成的语义地图更新信息;Obtain semantic map update information generated based on user operations;
    根据所述语义地图更新信息更新所述初始语义地图,以得到所述可移动平台运行环境的语义地图。The initial semantic map is updated according to the semantic map update information, so as to obtain the semantic map of the operating environment of the mobile platform.
  33. 根据权利要求32所述的装置,其特征在于,所述装置还包括:The apparatus of claim 32, wherein the apparatus further comprises:
    提供用户交互界面,在所述用户交互界面上显示所述初始语义地图;providing a user interaction interface on which the initial semantic map is displayed;
    所述获取基于用户操作生成的语义地图更新信息,包括:The acquiring semantic map update information generated based on user operations includes:
    获取基于用户在所述用户交互界面上的操作生成的语义地图更新信息。Obtain semantic map update information generated based on the user's operation on the user interface.
  34. 根据权利要求32所述的装置,其特征在于,所述语义地图更新信息包括所述语义地图中更新的图像区域的位置、形状和语义信息。The apparatus according to claim 32, wherein the semantic map update information includes position, shape and semantic information of the updated image area in the semantic map.
  35. 根据权利要求32所述的装置,其特征在于,所述语义地图更新信息还包括所述语义地图中更新的图像区域的语义信息对应的避障策略。The apparatus according to claim 32, wherein the semantic map update information further comprises an obstacle avoidance strategy corresponding to the semantic information of the updated image area in the semantic map.
  36. 根据权利要求32所述的装置,其特征在于,所述语义地图更新信息包括所述初始语义地图中的图像区域的语义信息对应的避障策略。The apparatus according to claim 32, wherein the semantic map update information includes an obstacle avoidance strategy corresponding to the semantic information of the image region in the initial semantic map.
  37. 根据权利要求28所述的装置,其特征在于,所述避障策略包括:侧面绕行策略、上方通过策略或下方通过策略中至少一种。The device according to claim 28, wherein the obstacle avoidance strategy includes at least one of: a side detour strategy, an upper pass strategy, or a downward pass strategy.
  38. 根据权利要求37所述的装置,其特征在于,所述侧面绕行策略包括:The apparatus of claim 37, wherein the side detour strategy comprises:
    当所述目标对象的尺寸满足预设条件时,采用第一侧面绕行策略进行侧面绕行,当所述目标对象的尺寸不满足所述预设条件时,采用第二侧面绕行策略进行侧面绕行。When the size of the target object satisfies the preset condition, the first side detour strategy is adopted to perform side detour, and when the size of the target object does not meet the preset condition, the second side detour strategy is adopted to perform side detour bypass.
  39. 根据权利要求38所述的装置,其特征在于,所述移动路径为弓字型路径,所述弓字型路径包括作业路径和横移路径,所述目标对象的尺寸是在垂直于所述作业路径的方向上所述目标对象的尺寸。The device according to claim 38, wherein the moving path is a bow-shaped path, the bow-shaped path includes a work path and a traverse path, and the size of the target object is perpendicular to the work path. The size of the target object in the direction of the path.
  40. 根据权利要求39所述的装置,其特征在于,还包括:The apparatus of claim 39, further comprising:
    通过比较所述目标对象的尺寸和所述作业路径的间距确定所述目标对象的尺寸是否满足所述预设条件。Whether the size of the target object satisfies the preset condition is determined by comparing the size of the target object with the distance between the working paths.
  41. 根据权利要求39所述的装置,其特征在于:The device of claim 39, wherein:
    所述第一侧面绕行策略包括:移动至相邻的作业路径;The first side detour strategy includes: moving to an adjacent working path;
    所述第二侧面绕行策略包括:从侧边绕行以继续当前的作业路径。The second side detour strategy includes detouring from the side to continue the current working path.
  42. 根据权利要求28所述的装置,其特征在于,还包括:The apparatus of claim 28, further comprising:
    当所述避障策略包括上方通过时,设置所述可移动平台的作业状态为禁止作业。When the obstacle avoidance strategy includes passing above, the operation state of the movable platform is set to prohibit operation.
  43. 根据权利要求28所述的装置,其特征在于,所述避障策略还包括安全距离信息,所述安全距离信息用于指示所述可移动平台相对于所述目标图像区域对应的目标对象的最小间距。The device according to claim 28, wherein the obstacle avoidance strategy further comprises safety distance information, and the safety distance information is used to indicate the minimum distance of the movable platform relative to the target object corresponding to the target image area. spacing.
  44. 根据权利要求43所述的装置,其特征在于,所述安全距离与以下至少一种相关:可移动平台的尺寸、可移动平台的作业半径。The apparatus of claim 43, wherein the safety distance is related to at least one of the following: the size of the movable platform, and the working radius of the movable platform.
  45. 根据权利要求28所述的装置,其特征在于,还包括:The apparatus of claim 28, further comprising:
    获取所述目标图像区域对应的高程信息;obtaining the elevation information corresponding to the target image area;
    所述根据所述目标图像区域的语义信息对应的可移动平台的避障策略,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径,包括:According to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, planning the moving path of the movable platform to avoid the target object corresponding to the target image area, including:
    根据所述目标图像区域的语义信息对应的可移动平台的避障策略以及所述目标图像区域对应的高程信息,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径。According to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area and the elevation information corresponding to the target image area, the moving path of the movable platform to avoid the target object corresponding to the target image area is planned.
  46. 根据权利要求45所述的装置,其特征在于,所述根据所述目标图像区域的语义信息对应的可移动平台的避障策略以及所述目标图像区域对应的高程信息,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径,包括:The device according to claim 45, wherein the movable platform is planned according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area and the elevation information corresponding to the target image area Avoiding the moving path of the target object corresponding to the target image area, including:
    当所述避障策略包括上方通过时,根据所述目标图像区域的语义信息对应的可移动平台的避障策略以及所述目标图像区域对应的高程信息,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径。When the obstacle avoidance strategy includes passing above, plan the movable platform to avoid the obstacle according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area and the elevation information corresponding to the target image area The moving path of the target object corresponding to the target image area.
  47. 根据权利要求28所述的装置,其特征在于,在所述根据所述目标图像区域的语义信息对应的可移动平台的避障策略,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径之后,还包括:The device according to claim 28, wherein in the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, the movable platform is planned to avoid the obstacle corresponding to the target image area. After the movement path of the target object, it also includes:
    控制所述可移动平台基于所述移动路径和所述可移动平台通过传感器检测到的障碍物信息进行移动。The movable platform is controlled to move based on the movement path and the obstacle information detected by the movable platform through the sensor.
  48. 根据权利要求47所述的装置,其特征在于,所述可移动平台是无人机,在控制所述可移动平台基于所述移动路径和所述可移动平台通过传感器检测到的障碍物信息进行移动的过程中,对于所述无人机检测到的障碍物,所述无人机从所述障碍物的上方通过的第一优先级高于从所述障碍物的下方通过的第二优先级。The device according to claim 47, wherein the movable platform is an unmanned aerial vehicle, and the control of the movable platform is based on the moving path and the obstacle information detected by the movable platform through sensors. During the movement, for the obstacle detected by the drone, the first priority of the drone passing above the obstacle is higher than the second priority passing below the obstacle .
  49. 根据权利要求47所述的装置,其特征在于,还包括:基于所述可移动平台检测到的障碍物更新所述语义地图。48. The apparatus of claim 47, further comprising: updating the semantic map based on obstacles detected by the movable platform.
  50. 根据权利要求47所述的装置,其特征在于,所述控制所述可移动平台基于所述移动路径和所述可移动平台通过传感器检测到的障碍物信息进行移动,包括:The device according to claim 47, wherein the controlling the movable platform to move based on the movement path and information of obstacles detected by the movable platform through sensors comprises:
    在所述传感器检测到的障碍物的置信度大于预设阈值时,控制所述可移动平台基于所述移动路径和所述可移动平台通过传感器检测到的障碍物信息 进行移动,所述障碍物的置信度与重复检测到所述障碍物的次数以及检测到所述障碍物时的环境信息相关。When the confidence of the obstacle detected by the sensor is greater than a preset threshold, the movable platform is controlled to move based on the moving path and the obstacle information detected by the movable platform through the sensor, and the obstacle is controlled to move. The confidence of is related to the number of times the obstacle is repeatedly detected and the environmental information when the obstacle is detected.
  51. 根据权利要求28所述的装置,其特征在于,还包括:提取所述语义地图的各区域的轮廓,以便至少基于所述目标图像区域的轮廓生成所述移动路径。28. The apparatus of claim 28, further comprising: extracting the outline of each area of the semantic map, so as to generate the movement path based on at least the outline of the target image area.
  52. 根据权利要求28所述的装置,其特征在于,所述移动路径满足以下至少一种条件:The device according to claim 28, wherein the movement path satisfies at least one of the following conditions:
    所述移动路径上的路径点与所述目标对象之间的距离大于安全距离;The distance between the path point on the moving path and the target object is greater than the safety distance;
    所述可移动平台从所述移动路径的初始路径点移动至目标路径点的资源消耗最优,所述资源包括以下至少一种:路径长度、能量或时间;以及The resource consumption of the movable platform from the initial waypoint of the movement path to the target waypoint is optimal, and the resource includes at least one of the following: path length, energy or time; and
    移动路径的平滑度满足可移动平台的机动要求。The smoothness of the moving path meets the maneuvering requirements of the movable platform.
  53. 根据权利要求28所述的装置,其特征在于,所述根据所述目标图像区域的语义信息对应的可移动平台的避障策略,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径包括:The device according to claim 28, wherein, according to the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, the movable platform is planned to avoid the target corresponding to the target image area The object's movement path includes:
    根据所述目标图像区域的三维位置信息和所述避障策略建立目标函数;establishing an objective function according to the three-dimensional position information of the target image area and the obstacle avoidance strategy;
    优化所述目标函数以确定所述可移动平台避开所述目标对象的移动路径。The objective function is optimized to determine a path of movement of the movable platform to avoid the target object.
  54. 根据权利要求28~53任一项所述的装置,其特征在于,在所述根据所述目标图像区域的语义信息对应的可移动平台的避障策略,规划所述可移动平台避开所述目标图像区域对应的目标对象的移动路径之后,还包括:The device according to any one of claims 28 to 53, wherein in the obstacle avoidance strategy of the movable platform corresponding to the semantic information of the target image area, the movable platform is planned to avoid the After the moving path of the target object corresponding to the target image area, it also includes:
    接收基于用户操作生成的控制杆量;Receive joystick amounts generated based on user actions;
    如果确定所述控制杆量指示所述可移动平台进入与所述目标图像区域,则不响应所述控制杆量。If it is determined that the lever amount indicates that the movable platform enters the target image area, the lever amount is not responded to.
  55. 一种路径规划系统,用于规划移动路径,其特征在于,所述系统包括:相互通信连接的控制终端和可移动平台,其中:A path planning system for planning a moving path, characterized in that the system comprises: a control terminal and a movable platform connected in communication with each other, wherein:
    所述控制终端和/或所述可移动平台包括权利要求28-54任一项所述的路径规划装置。The control terminal and/or the movable platform include the path planning apparatus according to any one of claims 28-54.
  56. 一种计算机可读存储介质,其特征在于,其上存储有计算机程序,所述计算机程序被处理器执行以实现权利要求1-27中任一项所述的方法。A computer-readable storage medium, characterized in that a computer program is stored thereon, and the computer program is executed by a processor to implement the method of any one of claims 1-27.
PCT/CN2020/127623 2020-11-09 2020-11-09 Path planning method, path planning apparatus, path planning system, and medium WO2022095060A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202080074264.5A CN114746822A (en) 2020-11-09 2020-11-09 Path planning method, path planning device, path planning system, and medium
PCT/CN2020/127623 WO2022095060A1 (en) 2020-11-09 2020-11-09 Path planning method, path planning apparatus, path planning system, and medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2020/127623 WO2022095060A1 (en) 2020-11-09 2020-11-09 Path planning method, path planning apparatus, path planning system, and medium

Publications (1)

Publication Number Publication Date
WO2022095060A1 true WO2022095060A1 (en) 2022-05-12

Family

ID=81458587

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2020/127623 WO2022095060A1 (en) 2020-11-09 2020-11-09 Path planning method, path planning apparatus, path planning system, and medium

Country Status (2)

Country Link
CN (1) CN114746822A (en)
WO (1) WO2022095060A1 (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114770559A (en) * 2022-05-27 2022-07-22 中迪机器人(盐城)有限公司 Fetching control system and method of robot
CN115202346A (en) * 2022-06-30 2022-10-18 广州极飞科技股份有限公司 Method, device and equipment for processing block target and storage medium
CN115460244A (en) * 2022-09-01 2022-12-09 苏州微木智能系统有限公司 Environment monitoring system, method and device
CN115577511A (en) * 2022-09-26 2023-01-06 南京航空航天大学 Short-term track prediction method, device and system based on unmanned aerial vehicle motion state
CN115963857A (en) * 2023-01-04 2023-04-14 广东博幻生态科技有限公司 Pesticide spraying method based on unmanned aerial vehicle
CN116952250A (en) * 2023-09-18 2023-10-27 之江实验室 Robot path guiding method and device based on semantic map
CN117705109A (en) * 2023-05-26 2024-03-15 荣耀终端有限公司 Path planning method, equipment and storage medium

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106840141A (en) * 2017-02-02 2017-06-13 王恒升 A kind of semantic map of mobile robot indoor navigation
CN110174888A (en) * 2018-08-09 2019-08-27 深圳瑞科时尚电子有限公司 Self-movement robot control method, device, equipment and storage medium
CN110986945A (en) * 2019-11-14 2020-04-10 上海交通大学 Local navigation method and system based on semantic height map
CN111679661A (en) * 2019-02-25 2020-09-18 北京奇虎科技有限公司 Semantic map construction method based on depth camera and sweeping robot

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106840141A (en) * 2017-02-02 2017-06-13 王恒升 A kind of semantic map of mobile robot indoor navigation
CN110174888A (en) * 2018-08-09 2019-08-27 深圳瑞科时尚电子有限公司 Self-movement robot control method, device, equipment and storage medium
CN111679661A (en) * 2019-02-25 2020-09-18 北京奇虎科技有限公司 Semantic map construction method based on depth camera and sweeping robot
CN110986945A (en) * 2019-11-14 2020-04-10 上海交通大学 Local navigation method and system based on semantic height map

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114770559A (en) * 2022-05-27 2022-07-22 中迪机器人(盐城)有限公司 Fetching control system and method of robot
CN114770559B (en) * 2022-05-27 2022-12-13 中迪机器人(盐城)有限公司 Fetching control system and method of robot
CN115202346A (en) * 2022-06-30 2022-10-18 广州极飞科技股份有限公司 Method, device and equipment for processing block target and storage medium
CN115460244A (en) * 2022-09-01 2022-12-09 苏州微木智能系统有限公司 Environment monitoring system, method and device
CN115577511A (en) * 2022-09-26 2023-01-06 南京航空航天大学 Short-term track prediction method, device and system based on unmanned aerial vehicle motion state
CN115577511B (en) * 2022-09-26 2023-11-17 南京航空航天大学 Short-term track prediction method, device and system based on unmanned aerial vehicle motion state
CN115963857A (en) * 2023-01-04 2023-04-14 广东博幻生态科技有限公司 Pesticide spraying method based on unmanned aerial vehicle
CN115963857B (en) * 2023-01-04 2023-08-08 广东博幻生态科技有限公司 Pesticide spraying method based on unmanned aerial vehicle
CN117705109A (en) * 2023-05-26 2024-03-15 荣耀终端有限公司 Path planning method, equipment and storage medium
CN116952250A (en) * 2023-09-18 2023-10-27 之江实验室 Robot path guiding method and device based on semantic map
CN116952250B (en) * 2023-09-18 2024-01-05 之江实验室 Robot path guiding method and device based on semantic map

Also Published As

Publication number Publication date
CN114746822A (en) 2022-07-12

Similar Documents

Publication Publication Date Title
WO2022095060A1 (en) Path planning method, path planning apparatus, path planning system, and medium
US11932392B2 (en) Systems and methods for adjusting UAV trajectory
US11797009B2 (en) Unmanned aerial image capture platform
WO2022095067A1 (en) Path planning method, path planning device, path planning system, and medium thereof
CN110325939B (en) System and method for operating an unmanned aerial vehicle
CN108521787B (en) Navigation processing method and device and control equipment
CN108351649B (en) Method and apparatus for controlling a movable object
JP2022184945A (en) Aerial vehicle smart landing
JP6324649B1 (en) Detection system, detection method, and program
CN110362102B (en) Method, device and system for generating unmanned aerial vehicle route
CN106054926A (en) Unmanned aerial vehicle following system and following flight control method
CN111051198A (en) Unmanned aerial vehicle control system, unmanned aerial vehicle control method, and program
JP7029565B2 (en) Maneuvering equipment, information processing methods, and programs
WO2022226720A1 (en) Path planning method, path planning device, and medium
WO2022087905A1 (en) Operation control method and device, and unmanned aerial vehicle and computer-readable storage medium
CN113841381B (en) Visual field determining method, visual field determining device, visual field determining system and medium
WO2022188151A1 (en) Image photographing method, control apparatus, movable platform, and computer storage medium
CN112639651A (en) Information processing method, information processing apparatus, and portable device
EP4024155B1 (en) Method, system and computer program product of control of unmanned aerial vehicles
JP2021036452A (en) System and method for adjusting uav locus

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20960517

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20960517

Country of ref document: EP

Kind code of ref document: A1