WO2021164277A1 - Spatial sampling method, apparatus, device, and medium applied to path planning - Google Patents

Spatial sampling method, apparatus, device, and medium applied to path planning Download PDF

Info

Publication number
WO2021164277A1
WO2021164277A1 PCT/CN2020/120756 CN2020120756W WO2021164277A1 WO 2021164277 A1 WO2021164277 A1 WO 2021164277A1 CN 2020120756 W CN2020120756 W CN 2020120756W WO 2021164277 A1 WO2021164277 A1 WO 2021164277A1
Authority
WO
WIPO (PCT)
Prior art keywords
sampling
point set
strategy
point
state space
Prior art date
Application number
PCT/CN2020/120756
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 平安科技(深圳)有限公司
Publication of WO2021164277A1 publication Critical patent/WO2021164277A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/08Programme-controlled manipulators characterised by modular constructions
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/18Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis

Definitions

  • This application relates to the field of artificial intelligence, and in particular to a spatial sampling method, device, equipment and medium applied to path planning.
  • path planning algorithms are widely used in various motion control fields, such as robotic arms, intelligent driving, unmanned aerial vehicles, etc.
  • the path planning method based on random sampling is one of the research hotspots.
  • the path planning method based on random sampling refers to the method of sampling the state space (solution space) to establish road signs or path branches. This method is probabilistically complete, that is, if there is a solution between the start point and the end point, as long as the number of sampling points is sufficient, a feasible path can be generated.
  • a spatial sampling method applied to path planning including:
  • a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy.
  • the first sampling strategy refers to sampling in the feasible region SL of the state space S;
  • the second sampling strategy refers to sampling in the effective point set S G ;
  • the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
  • a space sampling device applied to path planning including:
  • the pre-sampling module is used to determine the effective point set S G of the state space S through a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q via a first mapping relationship;
  • the random selection strategy module is used to select a sampling strategy from a specified number of sampling strategies as the execution strategy according to a preset random selection rule.
  • the specified number of sampling strategies at least include a first sampling strategy, a second sampling strategy, and The third sampling strategy, the first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to the first effective
  • the point set S G randomly selects the point B, then selects the point C belonging to the effective point set S G within the specified range of the point B, and performs sampling at any point between the point B and the point C;
  • the sampling module is used to perform sampling according to the execution strategy.
  • a computer device includes a memory, a processor, and computer-readable instructions that are stored in the memory and can run on the processor, and the processor implements the following steps when the processor executes the computer-readable instructions:
  • a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy.
  • the first sampling strategy refers to sampling in the feasible region SL of the state space S;
  • the second sampling strategy refers to sampling in the effective point set S G ;
  • the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
  • a computer-readable storage medium which stores computer-readable instructions, so that the one or more processors execute the following steps:
  • a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy.
  • the first sampling strategy refers to sampling in the feasible region SL of the state space S;
  • the second sampling strategy refers to sampling in the effective point set S G ;
  • the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
  • the above-mentioned spatial sampling method, device, computer equipment and storage medium applied to path planning determine the effective point set SG of the state space S through the pre-sampling method, and any point in the effective point set SG is mapped in the first mapping relationship In the feasible region QL of the state space Q, the feasible point set of the path planning is divided.
  • a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy.
  • the first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select the point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C to provide different sampling strategies and improve the flexibility of sampling. Sampling is performed according to the described execution strategy to complete the collection task.
  • This application uses pre-sampling and real-time sampling (that is, sampling using an execution strategy), which can improve the sampling success rate, reduce repeated sampling, and solve the problem of low or no solution in path planning under the condition of multiple state spaces and multiple constraints. , which greatly improves the processing efficiency of path planning and reduces sampling time.
  • FIG. 1 is a schematic diagram of an application environment of a spatial sampling method applied to path planning in an embodiment of the present application
  • FIG. 2 is a schematic flowchart of a spatial sampling method applied to path planning in an embodiment of the present application
  • Fig. 3 is a schematic diagram of the transformation between the feasible end space path and the axis space path of the 6-joint manipulator in an example
  • FIG. 4 is a schematic flowchart of a spatial sampling method applied to path planning in an embodiment of the present application
  • Fig. 5 is a schematic diagram of an example when the point set S LP in the state space S is mapped to the state space Q;
  • FIG. 6 is a schematic flowchart of a spatial sampling method applied to path planning in an embodiment of the present application
  • FIG. 7 is a schematic diagram of an example when the point set Q LT in the state space Q is mapped to the state space S;
  • FIG. 8 is a schematic flowchart of a spatial sampling method applied to path planning in an embodiment of the present application.
  • Fig. 9 is a schematic structural diagram of a spatial sampling device applied to path planning in an embodiment of the present application.
  • Fig. 10 is a schematic diagram of a computer device in an embodiment of the present application.
  • the spatial sampling method applied to path planning provided in this embodiment can be applied in an application environment as shown in FIG. 1, where the client communicates with the server.
  • the client includes, but is not limited to, various personal computers, notebook computers, smart phones, tablet computers, and portable wearable devices.
  • the server can be implemented with an independent server or a server cluster composed of multiple servers.
  • a spatial sampling method applied to path planning is provided. Taking the method applied to the server in FIG. 1 as an example, the method includes the following steps:
  • the state space S and the state space Q are different state spaces.
  • the path of the robotic arm is usually planned in the end space S ⁇ SE(3) or the axis space Q ⁇ R n (n is the number of joints).
  • the state space S is the end space
  • the state space Q is the axis space. All points in the state space S can find corresponding points in the state space Q, that is, there is a mapping relationship between the points in the state space S and the corresponding points in the state space Q.
  • mapping relationship from S to Q is the first mapping relationship, which can be expressed as: fK:
  • the mapping relationship from Q to S is the second mapping relationship, which can be expressed as: iK:
  • the first mapping relationship may also be referred to as a forward kinematics transformation relationship
  • the second mapping relationship may also be referred to as an inverse kinematics transformation relationship.
  • Fig. 3 is a schematic diagram of the transformation between the feasible end space path and the axis space path of the 6-joint manipulator in an example. The end position of the 6-joint robotic arm is determined by the rotation angles of the six joints (ie, shafts).
  • the angle of the first joint (that is, the rotation angle of the 1st axis on the left side of Fig. 3) can be mapped to the q1 coordinate on the upper right side of the figure. And so on.
  • the angle of each first joint can be mapped to the corresponding axis space coordinates.
  • the points in the state space S can all find the corresponding points in the state space Q, the feasible regions of different spaces do not completely overlap.
  • the points in the feasible region S LP in the state space S that are mapped to the points in the state space Q do not necessarily fall within the feasible region Q L of the state space Q.
  • the pre-sampling method is used to determine the set of points that fall in the feasible region before and after mapping.
  • the effective point set and Q G is the effective point set S G mapped to the point set on the state space Q.
  • the effective point set S G is the verified effective point taken in the space, which can ensure the validity of the sampling points during path planning, but the random exploration of the space is relatively low.
  • S20 Select a sampling strategy from a specified number of sampling strategies as an execution strategy according to a preset random selection rule, where the specified number of sampling strategies at least includes a first sampling strategy, a second sampling strategy, and a third sampling strategy.
  • the first sampling strategy refers to sampling in the feasible region SL of the state space S;
  • the second sampling strategy refers to sampling in the effective point set S G ;
  • the third sampling strategy refers to sampling in the effective point set S G first.
  • Select point B select point C belonging to the effective point set S G within the specified range of point B, and perform sampling at any point between point B and point C.
  • the first sampling strategy has the strongest random exploratory property but has the lowest guarantee of effectiveness.
  • the second sampling strategy has the strongest effectiveness, but the random exploration of the space is relatively low.
  • the performance of the third sampling strategy is between the first sampling strategy and the second sampling strategy.
  • the specified number may be greater than 3, that is, there is a fourth sampling strategy, a fifth sampling strategy, and so on.
  • the corresponding fourth sampling strategy, fifth sampling strategy, etc. can be formulated according to actual needs, which will not be repeated here.
  • the preset random selection rules can be formulated according to actual needs. In some cases, when multiple sampling is required, only one of the sampling strategies can be selected as the execution strategy. Here, a variety of different sampling strategies are provided, which greatly improves the flexibility of sampling.
  • sampling can be performed according to the execution strategy to complete point collection.
  • the corresponding execution strategy needs to be adopted for sampling.
  • Step S10-S30 it is determined by the effective pre-sampling point set S G S is the state space, the active set to any point in the point S G, the mapping in the first mapping relationship feasible region of the state space Q Q L, In order to divide the feasible point set of path planning.
  • a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy.
  • the first sampling strategy refers to sampling in the feasible region SL of the state space S;
  • the second sampling strategy refers to sampling in the effective point set S G ;
  • the third sampling strategy refers to randomly selecting points in the effective point set S G B.
  • Step S10 that is, determining the effective point set S G of the state space S through the pre-sampling method, includes:
  • the feasible area S L in the state space S, S (the cylindrical part on the left in FIG. 5) and the feasible area Q L in the state space Q, Q (the right cuboid in FIG. 5) are known.
  • the point set S LP in S L (the point on the upper left side of the cylinder in Figure 5).
  • the S LP is mapped to the state space Q through the function iK , and the point set Q LP is obtained (the white points inside the rectangular parallelepiped and the black points outside the rectangular parallelepiped in Figure 5).
  • the set point is a valid point set S A S G of the subset.
  • Step S10 that is, determining the effective point set S G of the state space S by the pre-sampling method includes:
  • the point set S QA is a subset of the effective point set S G.
  • S G S QA ⁇ S A.
  • S G is the set of points in the lowermost cylinder on the left side of Figure 7.
  • step S20 that is, selecting a sampling strategy from a specified number of sampling strategies according to a preset random selection rule as an execution strategy includes:
  • step S20 can be expressed as:
  • the third sampling strategy is the third sampling strategy.
  • the sampling strategy is randomly selected as the real-time sampling stage.
  • the three different sampling strategies provided in this embodiment have different characteristics.
  • the first sampling strategy has the strongest random exploration but the lowest guarantee of effectiveness.
  • the second sampling strategy has the strongest effectiveness, but the random exploration of the space is relatively low.
  • the performance of the third sampling strategy is between the first sampling strategy and the second sampling strategy.
  • W [0,1]
  • X is the first interval [0, r a)
  • said second section is Y [r a, r b)
  • the third zone Z is [r b, 1]
  • r a, r b is the hyper-parameters, and 0 ⁇ r a ⁇ r b ⁇ 1.
  • the random number r can be any number in [0,1].
  • r a and r b are hyper-parameters, and the values of these two hyper-parameters can be set according to actual needs to adjust the probability that different sampling strategies are selected.
  • a spatial sampling device applied to path planning is provided, and the spatial sampling device applied to path planning corresponds to the spatial sampling method applied to path planning in the above-mentioned embodiment in a one-to-one correspondence.
  • the spatial sampling device applied to path planning includes a pre-sampling module 10, a random selection strategy module 20, and a sampling module 30.
  • the detailed description of each functional module is as follows:
  • the pre-sampling module 10 is used to determine the effective point set S G of the state space S by a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q via a first mapping relationship ;
  • the random selection strategy module 20 is configured to select a sampling strategy from a specified number of sampling strategies as an execution strategy according to a preset random selection rule, and the specified number of sampling strategies at least include a first sampling strategy and a second sampling strategy
  • the first sampling strategy refers to sampling in the feasible region SL of the state space S
  • the second sampling strategy refers to sampling in the effective point set S G
  • the third sampling strategy refers to sampling in the first
  • the effective point set S G randomly selects the point B, and then selects the point C belonging to the effective point set S G within the specified range of the point B, and performs sampling at any point between the point B and the point C;
  • the sampling module 30 is configured to perform sampling according to the execution strategy.
  • the pre-sampling module 10 includes:
  • the first sampling unit is used for uniform sampling in the feasible region SL of the state space S to obtain the point set S LP ;
  • the first mapping unit is configured to map the point set S LP to the state space Q according to the first mapping relationship to obtain the point set Q LP ;
  • the first selection unit is configured to select points in the feasible region Q L from the point set Q LP to obtain the point set Q A ;
  • the first set point generation means for selecting the set of points Q A and the corresponding point of the point set S LP, the generation point set S A, the active point set comprising the set of points S G S A.
  • the pre-sampling module 10 includes:
  • the second sampling unit is used for uniform sampling in the feasible region Q L of the state space Q to obtain the point set Q LT ;
  • the second mapping unit is configured to map the point set Q LT to the state space S according to the second mapping relationship to obtain the point set S LT ;
  • the second selection unit is configured to select points in the feasible region SL from the point set S LT to obtain a point set S QA , and the effective point set S G includes the point set S QA .
  • the random selection strategy module 20 includes:
  • Random number generating unit used to randomly generate a random number r, the value range of the random number r is W;
  • the first selection strategy unit is configured to select the first sampling strategy as the execution strategy if the random number r is in the first interval X;
  • the second selection strategy unit is configured to select the second sampling strategy as the execution strategy if the random number r is in the second interval Y;
  • the third selection strategy unit is configured to select the third sampling strategy as the execution strategy if the random number r is in the third interval Z;
  • W [0,1]
  • X is the first interval [0, r a)
  • said second section is Y [r a, r b)
  • the third zone Z is [r b, 1]
  • r a, r b is the hyper-parameters, and 0 ⁇ r a ⁇ r b ⁇ 1.
  • Each module in the above-mentioned spatial sampling device applied to path planning can be implemented in whole or in part by software, hardware, and a combination thereof.
  • the above-mentioned modules may be embedded in the form of hardware or independent of the processor in the computer equipment, or may be stored in the memory of the computer equipment in the form of software, so that the processor can call and execute the operations corresponding to the above-mentioned modules.
  • a computer device is provided.
  • the computer device may be a server, and its internal structure diagram may be as shown in FIG. 10.
  • the computer equipment includes a processor, a memory, a network interface, and a database connected through a system bus.
  • the processor of the computer device is used to provide calculation and control capabilities.
  • the memory of the computer device includes a readable storage medium and an internal memory.
  • the readable storage medium stores an operating system, computer readable instructions, and a database.
  • the internal memory provides an environment for the operation of the operating system and computer readable instructions in the readable storage medium.
  • the database of the computer device is used to store the data involved in the above-mentioned spatial sampling method applied to path planning.
  • the network interface of the computer device is used to communicate with an external terminal through a network connection.
  • the computer-readable instructions are executed by the processor to realize a spatial sampling method applied to path planning.
  • the readable storage medium provided in this embodiment includes a non-volatile readable storage medium and a volatile readable storage medium.
  • a computer device including a memory, a processor, and computer-readable instructions stored on the memory and capable of running on the processor, and the processor implements the following steps when the processor executes the computer-readable instructions:
  • a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy.
  • the first sampling strategy refers to sampling in the feasible region SL of the state space S;
  • the second sampling strategy refers to sampling in the effective point set S G ;
  • the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
  • one or more computer-readable storage media storing computer-readable instructions are provided.
  • the readable storage media provided in this embodiment include non-volatile readable storage media and volatile readable storage media. Storage medium.
  • the readable storage medium stores computer readable instructions, and when the computer readable instructions are executed by one or more processors, the following steps are implemented:
  • a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy.
  • the first sampling strategy refers to sampling in the feasible region SL of the state space S;
  • the second sampling strategy refers to sampling in the effective point set S G ;
  • the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
  • Non-volatile memory may include read only memory (ROM), programmable ROM (PROM), electrically programmable ROM (EPROM), electrically erasable programmable ROM (EEPROM), or flash memory.
  • Volatile memory may include random access memory (RAM) or external cache memory.
  • RAM is available in many forms, such as static RAM (SRAM), dynamic RAM (DRAM), synchronous DRAM (SDRAM), double data rate SDRAM (DDRSDRAM), enhanced SDRAM (ESDRAM), synchronous chain Channel (Synchlink) DRAM (SLDRAM), memory bus (Rambus) direct RAM (RDRAM), direct memory bus dynamic RAM (DRDRAM), and memory bus dynamic RAM (RDRAM), etc.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Data Mining & Analysis (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Theoretical Computer Science (AREA)
  • Mathematical Physics (AREA)
  • Computational Mathematics (AREA)
  • Mathematical Analysis (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Operations Research (AREA)
  • Probability & Statistics with Applications (AREA)
  • Bioinformatics & Cheminformatics (AREA)
  • Algebra (AREA)
  • Evolutionary Biology (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Bioinformatics & Computational Biology (AREA)
  • Complex Calculations (AREA)

Abstract

Provided are a spatial sampling method, apparatus, device, and medium applied to path planning, said method comprising: determining an effective point set SG of a state space S by means of a pre-sampling method, any point in the effective point set SG being mapped in a feasible region QL of a state space Q via a first mapping relationship; according to a preset random selection rule, selecting as an execution strategy a sampling strategy from among a designated number of sampling strategies, the designated number of sampling strategies comprising at least a first sampling strategy, a second sampling strategy, and a third sampling strategy. In the case of multiple state spaces and multiple constraints, the method can increase the processing efficiency of path planning and reduce sampling time.

Description

应用于路径规划的空间采样方法、装置、设备及介质Spatial sampling method, device, equipment and medium applied to path planning
本申请要求于2020年7月31日提交中国专利局、申请号为202010763143.3,发明名称为“应用于路径规划的空间采样方法、装置、设备及介质”的中国专利申请的优先权,其全部内容通过引用结合在本申请中。This application claims the priority of a Chinese patent application filed with the Chinese Patent Office on July 31, 2020, the application number is 202010763143.3, and the invention title is "Spatial sampling methods, devices, equipment and media applied to path planning", and its entire contents Incorporated in this application by reference.
技术领域Technical field
本申请涉及人工智能领域,尤其涉及一种应用于路径规划的空间采样方法、装置、设备及介质。This application relates to the field of artificial intelligence, and in particular to a spatial sampling method, device, equipment and medium applied to path planning.
背景技术Background technique
近年来,路径规划方法的研究日益渐增。路径规划算法广泛应用于各个运动控制领域,如机械臂、智能驾驶、无人机等。其中,基于随机采样的路径规划方法是其中的研究热点。基于随机采样的路径规划方法指的是对状态空间(解空间)进行采样从而建立路标或路径分支的方法。该方法具有概率完备性,即,如果在起点和终点之间存在解,只要采样点数量足够多,就一定可以生成可行路径。In recent years, research on path planning methods has been increasing. Path planning algorithms are widely used in various motion control fields, such as robotic arms, intelligent driving, unmanned aerial vehicles, etc. Among them, the path planning method based on random sampling is one of the research hotspots. The path planning method based on random sampling refers to the method of sampling the state space (solution space) to establish road signs or path branches. This method is probabilistically complete, that is, if there is a solution between the start point and the end point, as long as the number of sampling points is sufficient, a feasible path can be generated.
目前,依据采样点生成路径的算法较多,诸如RRT(快速扩展随机树算法)、PRM(概率路线图算法)、KPIECE(一种基于决策树采样的运动规划算法)等。这些算法侧重于路径规划,并未涉及采样策略的改进。发明人意识到,对于一些环境复杂的状态空间(如多状态空间、多约束条件等),生成采样点耗时长,甚至难以生成采样点,影响路径规划的耗时。Currently, there are many algorithms for generating paths based on sampling points, such as RRT (Rapid Expanding Random Tree Algorithm), PRM (Probabilistic Roadmap Algorithm), KPIECE (a motion planning algorithm based on decision tree sampling) and so on. These algorithms focus on path planning and do not involve the improvement of sampling strategies. The inventor realizes that for some state spaces with complex environments (such as multi-state spaces, multiple constraints, etc.), it takes a long time to generate sampling points, and it is even difficult to generate sampling points, which affects the time-consuming path planning.
申请内容Application content
基于此,有必要针对上述技术问题,提供一种应用于路径规划的空间采样方法、装置、设备及介质,以解决在环境复杂的状态空间下,路径规划采样困难,耗时长的问题。Based on this, it is necessary to provide a spatial sampling method, device, equipment, and medium for path planning in response to the above technical problems, so as to solve the problem of difficult and time-consuming path planning sampling in a complex state space environment.
一种应用于路径规划的空间采样方法,包括:A spatial sampling method applied to path planning, including:
通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内; Determine the effective point set S G of the state space S by a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q through the first mapping relationship;
根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样; According to a preset random selection rule, a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy. The first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
按照所述执行策略进行采样。Sampling is performed according to the described execution strategy.
一种应用于路径规划的空间采样装置,包括:A space sampling device applied to path planning, including:
预采样模块,用于通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内; The pre-sampling module is used to determine the effective point set S G of the state space S through a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q via a first mapping relationship;
随机选取策略模块,用于根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样; The random selection strategy module is used to select a sampling strategy from a specified number of sampling strategies as the execution strategy according to a preset random selection rule. The specified number of sampling strategies at least include a first sampling strategy, a second sampling strategy, and The third sampling strategy, the first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to the first effective The point set S G randomly selects the point B, then selects the point C belonging to the effective point set S G within the specified range of the point B, and performs sampling at any point between the point B and the point C;
采样模块,用于按照所述执行策略进行采样。The sampling module is used to perform sampling according to the execution strategy.
一种计算机设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机可读指令,所述处理器执行所述计算机可读指令时实现如下步骤:A computer device includes a memory, a processor, and computer-readable instructions that are stored in the memory and can run on the processor, and the processor implements the following steps when the processor executes the computer-readable instructions:
通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内; Determine the effective point set S G of the state space S by a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q through the first mapping relationship;
根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样; According to a preset random selection rule, a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy. The first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
按照所述执行策略进行采样。Sampling is performed according to the described execution strategy.
一种计算机可读存储介质,所述计算机可读存储介质存储有计算机可读指令,使得所述一个或多个处理器执行如下步骤:A computer-readable storage medium, which stores computer-readable instructions, so that the one or more processors execute the following steps:
通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内; Determine the effective point set S G of the state space S by a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q through the first mapping relationship;
根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样; According to a preset random selection rule, a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy. The first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
按照所述执行策略进行采样。Sampling is performed according to the described execution strategy.
上述应用于路径规划的空间采样方法、装置、计算机设备及存储介质,通过预采样方法确定状态空间S的有效点集SG,所述有效点集SG中的任意一点,经第一映射关系映射在状态空间Q的可行区域QL内,以划分出路径规划的可行点集。根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样,以提供不同的采样策略,提高采样的灵活性。按照所述执行策略进行采样,以完成采集任务。本申请使用预采样和实时采样(即采用执行策略进行采样),可以提高采样成功率,减少反复采样,解决了路径规划在多状态空间、多约束条件的情况下求解效率低或无解的问题,大大提高了路径规划的处理效率,减少采样耗时。 The above-mentioned spatial sampling method, device, computer equipment and storage medium applied to path planning determine the effective point set SG of the state space S through the pre-sampling method, and any point in the effective point set SG is mapped in the first mapping relationship In the feasible region QL of the state space Q, the feasible point set of the path planning is divided. According to a preset random selection rule, a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy. The first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select the point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C to provide different sampling strategies and improve the flexibility of sampling. Sampling is performed according to the described execution strategy to complete the collection task. This application uses pre-sampling and real-time sampling (that is, sampling using an execution strategy), which can improve the sampling success rate, reduce repeated sampling, and solve the problem of low or no solution in path planning under the condition of multiple state spaces and multiple constraints. , Which greatly improves the processing efficiency of path planning and reduces sampling time.
本申请的一个或多个实施例的细节在下面的附图和描述中提出,本申请的其他特征和优点将从说明书、附图以及权利要求变得明显。The details of one or more embodiments of the present application are presented in the following drawings and description, and other features and advantages of the present application will become apparent from the description, drawings and claims.
附图说明Description of the drawings
为了更清楚地说明本申请实施例的技术方案,下面将对本申请实施例的描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。In order to explain the technical solutions of the embodiments of the present application more clearly, the following will briefly introduce the drawings that need to be used in the description of the embodiments of the present application. Obviously, the drawings in the following description are only some embodiments of the present application. For those of ordinary skill in the art, other drawings can be obtained based on these drawings without creative labor.
图1是本申请一实施例中应用于路径规划的空间采样方法的一应用环境示意图;FIG. 1 is a schematic diagram of an application environment of a spatial sampling method applied to path planning in an embodiment of the present application;
图2是本申请一实施例中应用于路径规划的空间采样方法的一流程示意图;FIG. 2 is a schematic flowchart of a spatial sampling method applied to path planning in an embodiment of the present application;
图3是一示例中6关节机械臂可行末端空间路径与轴空间路径进行变换的示意图;Fig. 3 is a schematic diagram of the transformation between the feasible end space path and the axis space path of the 6-joint manipulator in an example;
图4是本申请一实施例中应用于路径规划的空间采样方法的一流程示意图;4 is a schematic flowchart of a spatial sampling method applied to path planning in an embodiment of the present application;
图5是一示例中状态空间S中的点集S LP映射到状态空间Q时的示意图; Fig. 5 is a schematic diagram of an example when the point set S LP in the state space S is mapped to the state space Q;
图6是本申请一实施例中应用于路径规划的空间采样方法的一流程示意图;FIG. 6 is a schematic flowchart of a spatial sampling method applied to path planning in an embodiment of the present application;
图7是一示例中状态空间Q中的点集Q LT映射到状态空间S时的示意图; FIG. 7 is a schematic diagram of an example when the point set Q LT in the state space Q is mapped to the state space S;
图8是本申请一实施例中应用于路径规划的空间采样方法的一流程示意图;FIG. 8 is a schematic flowchart of a spatial sampling method applied to path planning in an embodiment of the present application;
图9是本申请一实施例中应用于路径规划的空间采样装置的一结构示意图;Fig. 9 is a schematic structural diagram of a spatial sampling device applied to path planning in an embodiment of the present application;
图10是本申请一实施例中计算机设备的一示意图。Fig. 10 is a schematic diagram of a computer device in an embodiment of the present application.
具体实施方式Detailed ways
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。The technical solutions in the embodiments of the present application will be described clearly and completely in conjunction with the accompanying drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, rather than all of them. Based on the embodiments in this application, all other embodiments obtained by those of ordinary skill in the art without creative work shall fall within the protection scope of this application.
本方案属于智慧交通领域,通过本方案能够推动智慧城市的建设。本实施例提供的应用于路径规划的空间采样方法,可应用在如图1的应用环境中,其中,客户端与服务端进行通信。其中,客户端包括但不限于各种个人计算机、笔记本电脑、智能手机、平板电脑和便携式可穿戴设备。服务端可以用独立的服务器或者是多个服务器组成的服务器集群来实现。This solution belongs to the field of smart transportation, and the construction of smart cities can be promoted through this solution. The spatial sampling method applied to path planning provided in this embodiment can be applied in an application environment as shown in FIG. 1, where the client communicates with the server. Among them, the client includes, but is not limited to, various personal computers, notebook computers, smart phones, tablet computers, and portable wearable devices. The server can be implemented with an independent server or a server cluster composed of multiple servers.
在一实施例中,如图2所示,提供一种应用于路径规划的空间采样方法,以该方法应用在图1中的服务端为例进行说明,包括如下步骤:In an embodiment, as shown in FIG. 2, a spatial sampling method applied to path planning is provided. Taking the method applied to the server in FIG. 1 as an example, the method includes the following steps:
S10、通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内。 S10. Determine the effective point set S G of the state space S by a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q through the first mapping relationship.
本实施例中,状态空间S与状态空间Q为不同的状态空间。在一示例中,机械臂的路径通常在末端空间S∈SE(3)或者轴空间Q∈R n(n为关节数)中规划。在此处,状态空间S为末端空间,状态空间Q为轴空间。状态空间S中的点均可以在状态空间Q中找到对应的点,即状态空间S中的点与状态空间Q中对应的点存在映射关系。具体的,从S映射到Q的映射关系为第一映射关系,可表示为:fK:
Figure PCTCN2020120756-appb-000001
从Q映射到S的映射关系为第二映射关系,可表示为:iK:
Figure PCTCN2020120756-appb-000002
在本示例中,第一映射关系也可称为正向运动学变换关 系,第二映射关系也可称为逆向运动学变换关系。如图3所示,图3为一示例中6关节机械臂可行末端空间路径与轴空间路径进行变换的示意图。6关节机械臂的末端位置由六个关节(即轴)的转动角度决定。其中,第一关节的角度(即图3左侧的1st axis的转动角度)可以映射到右图上方的q1坐标。以此类推。每个第一关节的角度可以映射到对应的轴空间坐标上。
In this embodiment, the state space S and the state space Q are different state spaces. In an example, the path of the robotic arm is usually planned in the end space SεSE(3) or the axis space QεR n (n is the number of joints). Here, the state space S is the end space, and the state space Q is the axis space. All points in the state space S can find corresponding points in the state space Q, that is, there is a mapping relationship between the points in the state space S and the corresponding points in the state space Q. Specifically, the mapping relationship from S to Q is the first mapping relationship, which can be expressed as: fK:
Figure PCTCN2020120756-appb-000001
The mapping relationship from Q to S is the second mapping relationship, which can be expressed as: iK:
Figure PCTCN2020120756-appb-000002
In this example, the first mapping relationship may also be referred to as a forward kinematics transformation relationship, and the second mapping relationship may also be referred to as an inverse kinematics transformation relationship. As shown in Fig. 3, Fig. 3 is a schematic diagram of the transformation between the feasible end space path and the axis space path of the 6-joint manipulator in an example. The end position of the 6-joint robotic arm is determined by the rotation angles of the six joints (ie, shafts). Among them, the angle of the first joint (that is, the rotation angle of the 1st axis on the left side of Fig. 3) can be mapped to the q1 coordinate on the upper right side of the figure. And so on. The angle of each first joint can be mapped to the corresponding axis space coordinates.
在此处,虽然状态空间S中的点均可以在状态空间Q中找到对应的点,但不同空间的可行区域并不完全重叠。也就是说,状态空间S中可行区域S LP内的点映射到状态空间Q的点并不一定落在状态空间Q的可行区域Q L内。预采样方法用于确定映射前和映射后均落在可行区域的点的集合。也就是说,有效点集
Figure PCTCN2020120756-appb-000003
Figure PCTCN2020120756-appb-000004
Q G为有效点集S G映射到状态空间Q上的点集。有效点集S G即为已验证的空间有效取点,可以在路径规划时确保取样点的有效性,但对空间的随机探索性相对较低。
Here, although the points in the state space S can all find the corresponding points in the state space Q, the feasible regions of different spaces do not completely overlap. In other words, the points in the feasible region S LP in the state space S that are mapped to the points in the state space Q do not necessarily fall within the feasible region Q L of the state space Q. The pre-sampling method is used to determine the set of points that fall in the feasible region before and after mapping. In other words, the effective point set
Figure PCTCN2020120756-appb-000003
and
Figure PCTCN2020120756-appb-000004
Q G is the effective point set S G mapped to the point set on the state space Q. The effective point set S G is the verified effective point taken in the space, which can ensure the validity of the sampling points during path planning, but the random exploration of the space is relatively low.
S20、根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样。 S20. Select a sampling strategy from a specified number of sampling strategies as an execution strategy according to a preset random selection rule, where the specified number of sampling strategies at least includes a first sampling strategy, a second sampling strategy, and a third sampling strategy. The first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to sampling in the effective point set S G first. Select point B, then select point C belonging to the effective point set S G within the specified range of point B, and perform sampling at any point between point B and point C.
本实施例中,第一采样策略具有最强的随机探索性但对有效性的保障最低。第二采样策略具有最强的有效性,但对空间的随机探索性相对较低.而第三采样策略的性能介于第一采样策略和第二采样策略之间。在一些情况下,指定个数可以是大于3,也即是存在第四采样策略、第五采样策略等。具体的,可以根据实际需要制定相应的第四采样策略、第五采样策略等,在此不再赘述。In this embodiment, the first sampling strategy has the strongest random exploratory property but has the lowest guarantee of effectiveness. The second sampling strategy has the strongest effectiveness, but the random exploration of the space is relatively low. The performance of the third sampling strategy is between the first sampling strategy and the second sampling strategy. In some cases, the specified number may be greater than 3, that is, there is a fourth sampling strategy, a fifth sampling strategy, and so on. Specifically, the corresponding fourth sampling strategy, fifth sampling strategy, etc. can be formulated according to actual needs, which will not be repeated here.
预设随机选取规则可以根据实际需要进行制定。在一些情况下,当需要多次采样时,可以只选取其中的一种采样策略作为执行策略。在此处,提供了多种不同的采样策略,大大提高了采样的灵活性。The preset random selection rules can be formulated according to actual needs. In some cases, when multiple sampling is required, only one of the sampling strategies can be selected as the execution strategy. Here, a variety of different sampling strategies are provided, which greatly improves the flexibility of sampling.
S30、按照所述执行策略进行采样。S30. Perform sampling according to the execution strategy.
本实施例中,在确定执行策略之后,可以按照执行策略进行采样,完成点的采集。在一次路径规划中,若需要采集的点多于一个,则需要采用相应的执行策略进行采样。这些执行策略可以是相同,也可以是不同。In this embodiment, after the execution strategy is determined, sampling can be performed according to the execution strategy to complete point collection. In a path planning, if more than one point needs to be collected, the corresponding execution strategy needs to be adopted for sampling. These execution strategies can be the same or different.
步骤S10-S30中,通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内,以划分出路径规划的可行点集。根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样,以提供不同的采样策略,提高采样的灵活性。按照所述执行策略进行采样,以完成采集任务。 Step S10-S30, it is determined by the effective pre-sampling point set S G S is the state space, the active set to any point in the point S G, the mapping in the first mapping relationship feasible region of the state space Q Q L, In order to divide the feasible point set of path planning. According to a preset random selection rule, a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy. The first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select the point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C to provide different sampling strategies and improve the flexibility of sampling. Sampling is performed according to the described execution strategy to complete the collection task.
可选的,请参考图4和5,步骤S10,即所述通过预采样方法确定状态空间S的有效点集S G,包括: Optionally, please refer to Figures 4 and 5. Step S10, that is, determining the effective point set S G of the state space S through the pre-sampling method, includes:
S101、在状态空间S的可行区域S L均匀取样,得到点集S LPS101. Sampling uniformly in the feasible region S L of the state space S to obtain a point set S LP ;
S102、根据所述第一映射关系将所述点集S LP映射到状态空间Q,获得点集Q LPS102. Map the point set S LP to the state space Q according to the first mapping relationship to obtain a point set Q LP ;
S103、从所述点集Q LP中选取处于所述可行区域Q L内的点,获得点集Q AS103. Select a point in the feasible region Q L from the point set Q LP to obtain a point set Q A ;
S104、在所述点集S LP中选取与所述点集Q A对应的点,生成点集S A,所述有效点集S G包括所述点集S AS104, select the point in the set S LP set point corresponding to the point Q A, generating point set S A, the active point set comprising the set of points S G S A.
本实施例中,已知状态空间S,S中的可行区域S L(图5中左侧圆柱部分)以及状态空间Q,Q中的可行区域Q L(图5中右侧长方体)。首先,在S L内均匀采样得到点集S LP(如图5中左上侧圆柱的点)。然后通过函数iK把S LP映射到状态空间Q中,得到点集Q LP(图5中长方体内的白点和长方体外的黑点)。最后在Q LP中筛选出符合Q L的点(长方体内的白点),并在S LP找到与其对应的采样点(如图5中左下侧圆柱内颜色较深的点),从而得到状态空间S有效采样的点集S A,则: In this embodiment, the feasible area S L in the state space S, S (the cylindrical part on the left in FIG. 5) and the feasible area Q L in the state space Q, Q (the right cuboid in FIG. 5) are known. First, uniformly sample the point set S LP in S L (the point on the upper left side of the cylinder in Figure 5). Then the S LP is mapped to the state space Q through the function iK , and the point set Q LP is obtained (the white points inside the rectangular parallelepiped and the black points outside the rectangular parallelepiped in Figure 5). Finally, in Q LP , the points that meet Q L (white points in the cuboid) are screened out, and the corresponding sampling points are found in S LP (the darker points in the lower left side of the cylinder in Figure 5), so as to obtain the state space The point set S A effectively sampled by S, then:
S A={p|p∈S LP∧iK(p)∈Q L}。 S A ={p|p∈S LP ∧iK(p)∈Q L }.
在此处,点集S A为有效点集S G的子集。 Here, the set point is a valid point set S A S G of the subset.
可选的,请参考图6和7,步骤S10,即所述通过预采样方法确定状态空间S的有效点集S G,包括: Optionally, please refer to FIGS. 6 and 7. Step S10, that is, determining the effective point set S G of the state space S by the pre-sampling method includes:
S105、在状态空间Q的可行区域Q L均匀取样,得到点集Q LTS105. Sampling uniformly in the feasible region Q L of the state space Q to obtain a point set Q LT ;
S106、根据第二映射关系将所述点集Q LT映射到状态空间S,获得点集S LTS106: Map the point set Q LT to the state space S according to the second mapping relationship to obtain the point set S LT ;
S107、从所述点集S LT中选取处于所述可行区域S L内的点,获得点集S QA,所述有效点集S G包括所述点集S QAS107. Select points within the feasible region SL from the point set S LT to obtain a point set S QA , and the effective point set S G includes the point set S QA .
本实施例中,首先在Q L均匀采样得到点集Q LT(如图7长方体内的点)。然后通过函数fK把Q LT映射到状态空间S中,得到点集S LT(图7左侧最上方圆柱内的灰点和圆柱外的黑点)。最后在S LT中筛选出符合S L的点(图7左侧最上方圆柱内的灰点),得到点集S QA。即: In this embodiment, first, uniform sampling is performed on Q L to obtain a point set Q LT (as shown in Figure 7 for points in a rectangular parallelepiped). Then the Q LT is mapped to the state space S through the function fK to obtain the point set S LT (the gray point in the uppermost cylinder on the left side of Fig. 7 and the black point outside the cylinder). Finally, the points that meet S L are selected in S LT (the gray points in the uppermost cylinder on the left side of Fig. 7), and the point set S QA is obtained . which is:
S QA={p|p∈Q LT∧fK(p)∈S L}。 S QA ={p|pεQ LT ∧fK(p)εS L }.
在此处,点集S QA为有效点集S G的子集。S G=S QA∪S A。S G即为图7左侧最下方圆柱内的点的集合。 Here, the point set S QA is a subset of the effective point set S G. S G =S QA ∪S A. S G is the set of points in the lowermost cylinder on the left side of Figure 7.
可选的,如图8所示,步骤S20,即所述根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,包括:Optionally, as shown in FIG. 8, step S20, that is, selecting a sampling strategy from a specified number of sampling strategies according to a preset random selection rule as an execution strategy includes:
S201、随机生成随机数r,随机数r的取值区间为W;S201. Randomly generate a random number r, and the value range of the random number r is W;
S202、若随机数r处于第一区间X,则选取第一采样策略作为执行策略;S202: If the random number r is in the first interval X, select the first sampling strategy as the execution strategy;
S203、若随机数r处于第二区间Y,则选取第二采样策略作为执行策略;S203: If the random number r is in the second interval Y, select the second sampling strategy as the execution strategy;
S204、若随机数r处于第三区间Z,则选取第三采样策略作为执行策略;S204: If the random number r is in the third interval Z, select the third sampling strategy as the execution strategy;
其中,
Figure PCTCN2020120756-appb-000005
X∪Y∪Z=W。
in,
Figure PCTCN2020120756-appb-000005
X∪Y∪Z=W.
本实施例中,可以通过随机数生成函数生成随机数r,且r的取值区间为W,即:r=rand(),r∈W。In this embodiment, a random number r can be generated by a random number generation function, and the value interval of r is W, that is, r=rand(), r∈W.
在一些情况下,若X、Y、Z均为连续区间,由于X∪Y∪Z=W,则在W存在分割点r a、r b,将W分割为区间X、Y、Z。 In some cases, if the X, Y, Z are continuous segment, since X∪Y∪Z = W, W is present at the split point r a, r b, W is divided into the sections X, Y, Z.
因而,步骤S20可表示为:Therefore, step S20 can be expressed as:
r=rand(),r∈[0,1]r=rand(),r∈[0,1]
if(r≤r a): if(r≤r a ):
第一采样策略First sampling strategy
elseif(r a<r≤r b): elseif(r a <r≤r b ):
第二采样策略Second sampling strategy
else:else:
第三采样策略。The third sampling strategy.
在此处,随机选取采样策略为实时采样阶段。本实施例提供的三种不同采样策略具有不同的特点。第一采样策略具有最强的随机探索性但对有效性的保障最低。第二采样策略具有最强的有效性,但对空间的随机探索性相对较低.而第三采样策略的性能介于第一采样策略和第二采样策略之间。使用时可依据实际情况调整执行比例,使路径规划采样算法在效率和探索性能之间取得平衡。Here, the sampling strategy is randomly selected as the real-time sampling stage. The three different sampling strategies provided in this embodiment have different characteristics. The first sampling strategy has the strongest random exploration but the lowest guarantee of effectiveness. The second sampling strategy has the strongest effectiveness, but the random exploration of the space is relatively low. The performance of the third sampling strategy is between the first sampling strategy and the second sampling strategy. When in use, the execution ratio can be adjusted according to the actual situation, so that the path planning sampling algorithm can strike a balance between efficiency and exploration performance.
可选的,W=[0,1],所述第一区间X为[0,r a),所述第二区间Y为[r a,r b),所述第三区间Z为[r b,1],r a、r b为超参数,且0<r a<r b<1。 Alternatively, W = [0,1], X is the first interval [0, r a), said second section is Y [r a, r b), the third zone Z is [r b, 1], r a, r b is the hyper-parameters, and 0 <r a <r b < 1.
本实施例中,随机数r可以选取[0,1]中的任意一个数。r a、r b为超参数,可以根据实际需要设置这两个超参数的值,以调整不同采样策略被选取的概率。 In this embodiment, the random number r can be any number in [0,1]. r a and r b are hyper-parameters, and the values of these two hyper-parameters can be set according to actual needs to adjust the probability that different sampling strategies are selected.
应理解,上述实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本申请实施例的实施过程构成任何限定。It should be understood that the size of the sequence number of each step in the foregoing embodiment does not mean the order of execution. The execution sequence of each process should be determined by its function and internal logic, and should not constitute any limitation on the implementation process of the embodiment of the present application.
在一实施例中,提供一种应用于路径规划的空间采样装置,该应用于路径规划的空间采样装置与上述实施例中应用于路径规划的空间采样方法一一对应。如图9所示,该应用于路径规划的空间采样装置包括预采样模块10、随机选取策略模块20和采样模块30。各功能模块详细说明如下:In one embodiment, a spatial sampling device applied to path planning is provided, and the spatial sampling device applied to path planning corresponds to the spatial sampling method applied to path planning in the above-mentioned embodiment in a one-to-one correspondence. As shown in FIG. 9, the spatial sampling device applied to path planning includes a pre-sampling module 10, a random selection strategy module 20, and a sampling module 30. The detailed description of each functional module is as follows:
预采样模块10,用于通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内; The pre-sampling module 10 is used to determine the effective point set S G of the state space S by a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q via a first mapping relationship ;
随机选取策略模块20,用于根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样; The random selection strategy module 20 is configured to select a sampling strategy from a specified number of sampling strategies as an execution strategy according to a preset random selection rule, and the specified number of sampling strategies at least include a first sampling strategy and a second sampling strategy And the third sampling strategy, the first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to sampling in the first The effective point set S G randomly selects the point B, and then selects the point C belonging to the effective point set S G within the specified range of the point B, and performs sampling at any point between the point B and the point C;
采样模块30,用于按照所述执行策略进行采样。The sampling module 30 is configured to perform sampling according to the execution strategy.
可选的,预采样模块10包括:Optionally, the pre-sampling module 10 includes:
第一取样单元,用于在状态空间S的可行区域S L均匀取样,得到点集S LPThe first sampling unit is used for uniform sampling in the feasible region SL of the state space S to obtain the point set S LP ;
第一映射单元,用于根据所述第一映射关系将所述点集S LP映射到状态空间Q,获得点集Q LPThe first mapping unit is configured to map the point set S LP to the state space Q according to the first mapping relationship to obtain the point set Q LP ;
第一选取单元,用于从所述点集Q LP中选取处于所述可行区域Q L内的点,获得点集 Q AThe first selection unit is configured to select points in the feasible region Q L from the point set Q LP to obtain the point set Q A ;
第一生成点集单元,用于在所述点集S LP中选取与所述点集Q A对应的点,生成点集S A,所述有效点集S G包括所述点集S AThe first set point generation means, for selecting the set of points Q A and the corresponding point of the point set S LP, the generation point set S A, the active point set comprising the set of points S G S A.
可选的,预采样模块10包括:Optionally, the pre-sampling module 10 includes:
第二取样单元,用于在状态空间Q的可行区域Q L均匀取样,得到点集Q LTThe second sampling unit is used for uniform sampling in the feasible region Q L of the state space Q to obtain the point set Q LT ;
第二映射单元,用于根据第二映射关系将所述点集Q LT映射到状态空间S,获得点集S LTThe second mapping unit is configured to map the point set Q LT to the state space S according to the second mapping relationship to obtain the point set S LT ;
第二选取单元,用于从所述点集S LT中选取处于所述可行区域S L内的点,获得点集S QA,所述有效点集S G包括所述点集S QAThe second selection unit is configured to select points in the feasible region SL from the point set S LT to obtain a point set S QA , and the effective point set S G includes the point set S QA .
可选的,随机选取策略模块20包括:Optionally, the random selection strategy module 20 includes:
生成随机数单元,用于随机生成随机数r,随机数r的取值区间为W;Random number generating unit, used to randomly generate a random number r, the value range of the random number r is W;
第一选取策略单元,用于若随机数r处于第一区间X,则选取第一采样策略作为执行策略;The first selection strategy unit is configured to select the first sampling strategy as the execution strategy if the random number r is in the first interval X;
第二选取策略单元,用于若随机数r处于第二区间Y,则选取第二采样策略作为执行策略;The second selection strategy unit is configured to select the second sampling strategy as the execution strategy if the random number r is in the second interval Y;
第三选取策略单元,用于若随机数r处于第三区间Z,则选取第三采样策略作为执行策略;The third selection strategy unit is configured to select the third sampling strategy as the execution strategy if the random number r is in the third interval Z;
其中,
Figure PCTCN2020120756-appb-000006
X∪Y∪Z=W。
in,
Figure PCTCN2020120756-appb-000006
X∪Y∪Z=W.
可选的,W=[0,1],所述第一区间X为[0,r a),所述第二区间Y为[r a,r b),所述第三区间Z为[r b,1],r a、r b为超参数,且0<r a<r b<1。 Alternatively, W = [0,1], X is the first interval [0, r a), said second section is Y [r a, r b), the third zone Z is [r b, 1], r a, r b is the hyper-parameters, and 0 <r a <r b < 1.
关于应用于路径规划的空间采样装置的具体限定可以参见上文中对于应用于路径规划的空间采样方法的限定,在此不再赘述。上述应用于路径规划的空间采样装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。For the specific limitation of the spatial sampling device applied to path planning, please refer to the above limitation of the spatial sampling method applied to path planning, which will not be repeated here. Each module in the above-mentioned spatial sampling device applied to path planning can be implemented in whole or in part by software, hardware, and a combination thereof. The above-mentioned modules may be embedded in the form of hardware or independent of the processor in the computer equipment, or may be stored in the memory of the computer equipment in the form of software, so that the processor can call and execute the operations corresponding to the above-mentioned modules.
在一个实施例中,提供了一种计算机设备,该计算机设备可以是服务器,其内部结构图可以如图10所示。该计算机设备包括通过系统总线连接的处理器、存储器、网络接口和数据库。其中,该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括可读存储介质、内存储器。该可读存储介质存储有操作系统、计算机可读指令和数据库。该内存储器为可读存储介质中的操作系统和计算机可读指令的运行提供环境。该计算机设备的数据库用于存储上述应用于路径规划的空间采样方法所涉及的数据。该计算机设备的网络接口用于与外部的终端通过网络连接通信。该计算机可读指令被处理器执行时以实现一种应用于路径规划的空间采样方法。本实施例所提供的可读存储介质包括非易失性可读存储介质和易失性可读存储介质。In one embodiment, a computer device is provided. The computer device may be a server, and its internal structure diagram may be as shown in FIG. 10. The computer equipment includes a processor, a memory, a network interface, and a database connected through a system bus. Among them, the processor of the computer device is used to provide calculation and control capabilities. The memory of the computer device includes a readable storage medium and an internal memory. The readable storage medium stores an operating system, computer readable instructions, and a database. The internal memory provides an environment for the operation of the operating system and computer readable instructions in the readable storage medium. The database of the computer device is used to store the data involved in the above-mentioned spatial sampling method applied to path planning. The network interface of the computer device is used to communicate with an external terminal through a network connection. The computer-readable instructions are executed by the processor to realize a spatial sampling method applied to path planning. The readable storage medium provided in this embodiment includes a non-volatile readable storage medium and a volatile readable storage medium.
在一个实施例中,提供了一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机可读指令,处理器执行计算机可读指令时实现以下步骤:In one embodiment, a computer device is provided, including a memory, a processor, and computer-readable instructions stored on the memory and capable of running on the processor, and the processor implements the following steps when the processor executes the computer-readable instructions:
通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内; Determine the effective point set S G of the state space S by a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q through the first mapping relationship;
根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所 述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样; According to a preset random selection rule, a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy. The first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
按照所述执行策略进行采样。Sampling is performed according to the described execution strategy.
在一个实施例中,提供了一个或多个存储有计算机可读指令的计算机可读存储介质,本实施例所提供的可读存储介质包括非易失性可读存储介质和易失性可读存储介质。可读存储介质上存储有计算机可读指令,计算机可读指令被一个或多个处理器执行时实现以下步骤:In one embodiment, one or more computer-readable storage media storing computer-readable instructions are provided. The readable storage media provided in this embodiment include non-volatile readable storage media and volatile readable storage media. Storage medium. The readable storage medium stores computer readable instructions, and when the computer readable instructions are executed by one or more processors, the following steps are implemented:
通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内; Determine the effective point set S G of the state space S by a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q through the first mapping relationship;
根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样; According to a preset random selection rule, a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy. The first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
按照所述执行策略进行采样。Sampling is performed according to the described execution strategy.
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机可读指令来指令相关的硬件来完成,所述的计算机可读指令可存储于一非易失性计算机可读取存储介质中,该计算机可读指令在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(ROM)、可编程ROM(PROM)、电可编程ROM(EPROM)、电可擦除可编程ROM(EEPROM)或闪存。易失性存储器可包括随机存取存储器(RAM)或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,诸如静态RAM(SRAM)、动态RAM(DRAM)、同步DRAM(SDRAM)、双数据率SDRAM(DDRSDRAM)、增强型SDRAM(ESDRAM)、同步链路(Synchlink)DRAM(SLDRAM)、存储器总线(Rambus)直接RAM(RDRAM)、直接存储器总线动态RAM(DRDRAM)、以及存储器总线动态RAM(RDRAM)等。A person of ordinary skill in the art can understand that all or part of the processes in the methods of the foregoing embodiments can be implemented by instructing relevant hardware through computer-readable instructions. The computer-readable instructions can be stored in a non-volatile computer. In a readable storage medium, when the computer-readable instructions are executed, they may include the processes of the above-mentioned method embodiments. Wherein, any reference to memory, storage, database, or other media used in the embodiments provided in this application may include non-volatile and/or volatile memory. Non-volatile memory may include read only memory (ROM), programmable ROM (PROM), electrically programmable ROM (EPROM), electrically erasable programmable ROM (EEPROM), or flash memory. Volatile memory may include random access memory (RAM) or external cache memory. As an illustration and not a limitation, RAM is available in many forms, such as static RAM (SRAM), dynamic RAM (DRAM), synchronous DRAM (SDRAM), double data rate SDRAM (DDRSDRAM), enhanced SDRAM (ESDRAM), synchronous chain Channel (Synchlink) DRAM (SLDRAM), memory bus (Rambus) direct RAM (RDRAM), direct memory bus dynamic RAM (DRDRAM), and memory bus dynamic RAM (RDRAM), etc.
所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,仅以上述各功能单元、模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能单元、模块完成,即将所述装置的内部结构划分成不同的功能单元或模块,以完成以上描述的全部或者部分功能。Those skilled in the art can clearly understand that, for the convenience and conciseness of description, only the division of the above functional units and modules is used as an example. In practical applications, the above functions can be allocated to different functional units and modules as needed. Module completion, that is, the internal structure of the device is divided into different functional units or modules to complete all or part of the functions described above.
以上所述实施例仅用以说明本申请的技术方案,而非对其限制;尽管参照前述实施例对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请各实施例技术方案的精神和范围,均应包含在本申请的保护范围之内。The above-mentioned embodiments are only used to illustrate the technical solutions of the present application, not to limit them; although the present application has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that they can still implement the foregoing The technical solutions recorded in the examples are modified, or some of the technical features are equivalently replaced; these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the spirit and scope of the technical solutions of the embodiments of the application, and should be included in Within the scope of protection of this application.

Claims (20)

  1. 一种应用于路径规划的空间采样方法,其中,包括:A spatial sampling method applied to path planning, which includes:
    通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内; Determine the effective point set S G of the state space S by a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q through the first mapping relationship;
    根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样; According to a preset random selection rule, a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy. The first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
    按照所述执行策略进行采样。Sampling is performed according to the described execution strategy.
  2. 如权利要求1所述的应用于路径规划的空间采样方法,其中,所述通过预采样方法确定状态空间S的有效点集S G,包括: The spatial sampling method applied to path planning according to claim 1, wherein said determining the effective point set S G of the state space S by the pre-sampling method comprises:
    在状态空间S的可行区域S L均匀取样,得到点集S LPSampling uniformly in the feasible region S L of the state space S to obtain the point set S LP ;
    根据所述第一映射关系将所述点集S LP映射到状态空间Q,获得点集Q LP Map the point set S LP to the state space Q according to the first mapping relationship to obtain the point set Q LP ;
    从所述点集Q LP中选取处于所述可行区域Q L内的点,获得点集Q ASelect a point in the feasible region Q L from the point set Q LP to obtain a point set Q A ;
    在所述点集S LP中选取与所述点集Q A对应的点,生成点集S A,所述有效点集S G包括所述点集S ASelecting the set of points in S LP set of points Q A and the corresponding points, generating a set point S A, the active point set comprising the set of points S G S A.
  3. 如权利要求1所述的应用于路径规划的空间采样方法,其中,所述通过预采样方法确定状态空间S的有效点集S G,包括: The spatial sampling method applied to path planning according to claim 1, wherein said determining the effective point set S G of the state space S by the pre-sampling method comprises:
    在状态空间Q的可行区域Q L均匀取样,得到点集Q LTSampling uniformly in the feasible region Q L of the state space Q to obtain the point set Q LT ;
    根据第二映射关系将所述点集Q LT映射到状态空间S,获得点集S LT Map the point set Q LT to the state space S according to the second mapping relationship to obtain the point set S LT ;
    从所述点集S LT中选取处于所述可行区域S L内的点,获得点集S QA,所述有效点集S G包括所述点集S QAA point within the feasible region SL is selected from the point set S LT to obtain a point set S QA , and the effective point set S G includes the point set S QA .
  4. 如权利要求1所述的应用于路径规划的空间采样方法,其中,所述根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,包括:The spatial sampling method applied to path planning according to claim 1, wherein the selecting a sampling strategy from a specified number of sampling strategies as the execution strategy according to a preset random selection rule comprises:
    随机生成随机数r,随机数r的取值区间为W;Randomly generate random number r, the value range of random number r is W;
    若随机数r处于第一区间X,则选取第一采样策略作为执行策略;If the random number r is in the first interval X, the first sampling strategy is selected as the execution strategy;
    若随机数r处于第二区间Y,则选取第二采样策略作为执行策略;If the random number r is in the second interval Y, the second sampling strategy is selected as the execution strategy;
    若随机数r处于第三区间Z,则选取第三采样策略作为执行策略;If the random number r is in the third interval Z, the third sampling strategy is selected as the execution strategy;
    其中,
    Figure PCTCN2020120756-appb-100001
    X∪Y∪Z=W。
    in,
    Figure PCTCN2020120756-appb-100001
    X∪Y∪Z=W.
  5. 如权利要求4所述的应用于路径规划的空间采样方法,其中,W=[0,1],所述第一区间X为[0,r a),所述第二区间Y为[r a,r b),所述第三区间Z为[r b,1],r a、r b为超参数,且0<r a<r b<1。 Spatial sampling method as claimed in claim 4 is applied to path planning, where, W = [0,1], X is the first interval [0, r a), said second section is Y [r a , r b), the third zone Z is [r b, 1], r a, r b is the hyper-parameters, and 0 <r a <r b < 1.
  6. 一种应用于路径规划的空间采样装置,其中,包括:A space sampling device applied to path planning, which includes:
    预采样模块,用于通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内; The pre-sampling module is used to determine the effective point set S G of the state space S through a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q via a first mapping relationship;
    随机选取策略模块,用于根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和 第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样; The random selection strategy module is used to select a sampling strategy from a specified number of sampling strategies as the execution strategy according to a preset random selection rule. The specified number of sampling strategies at least include a first sampling strategy, a second sampling strategy, and The third sampling strategy, the first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to the first effective The point set S G randomly selects the point B, then selects the point C belonging to the effective point set S G within the specified range of the point B, and performs sampling at any point between the point B and the point C;
    采样模块,用于按照所述执行策略进行采样。The sampling module is used to perform sampling according to the execution strategy.
  7. 如权利要求6所述的应用于路径规划的空间采样装置,其中,所述预采样模块包括:The spatial sampling device applied to path planning according to claim 6, wherein the pre-sampling module comprises:
    第一取样单元,用于在状态空间S的可行区域S L均匀取样,得到点集S LPThe first sampling unit is used for uniform sampling in the feasible region SL of the state space S to obtain the point set S LP ;
    第一映射单元,用于根据所述第一映射关系将所述点集S LP映射到状态空间Q,获得点集Q LPThe first mapping unit is configured to map the point set S LP to the state space Q according to the first mapping relationship to obtain the point set Q LP ;
    第一选取单元,用于从所述点集Q LP中选取处于所述可行区域Q L内的点,获得点集Q AThe first selection unit is configured to select points in the feasible region Q L from the point set Q LP to obtain the point set Q A ;
    第一生成点集单元,用于在所述点集S LP中选取与所述点集Q A对应的点,生成点集S A,所述有效点集S G包括所述点集S AThe first set point generation means, for selecting the set of points Q A and the corresponding point of the point set S LP, the generation point set S A, the active point set comprising the set of points S G S A.
  8. 如权利要求6所述的应用于路径规划的空间采样装置,其中,所述预采样模块包括:The spatial sampling device applied to path planning according to claim 6, wherein the pre-sampling module comprises:
    第二取样单元,用于在状态空间Q的可行区域Q L均匀取样,得到点集Q LTThe second sampling unit is used for uniform sampling in the feasible region Q L of the state space Q to obtain the point set Q LT ;
    第二映射单元,用于根据所述第二映射关系将所述点集Q LT映射到状态空间S,获得点集S LTThe second mapping unit is configured to map the point set Q LT to the state space S according to the second mapping relationship to obtain the point set S LT ;
    第二选取单元,用于从所述点集S LT中选取处于所述可行区域S L内的点,获得点集S QA,所述有效点集S G包括所述点集S QAThe second selection unit is configured to select points in the feasible region SL from the point set S LT to obtain a point set S QA , and the effective point set S G includes the point set S QA .
  9. 如权利要求6所述的应用于路径规划的空间采样装置,随机选取策略模块20包括:According to the space sampling device applied to path planning according to claim 6, the random selection strategy module 20 includes:
    生成随机数单元,用于随机生成随机数r,随机数r的取值区间为W;Random number generating unit, used to randomly generate a random number r, the value range of the random number r is W;
    第一选取策略单元,用于若随机数r处于第一区间X,则选取第一采样策略作为执行策略;The first selection strategy unit is configured to select the first sampling strategy as the execution strategy if the random number r is in the first interval X;
    第二选取策略单元,用于若随机数r处于第二区间Y,则选取第二采样策略作为执行策略;The second selection strategy unit is configured to select the second sampling strategy as the execution strategy if the random number r is in the second interval Y;
    第三选取策略单元,用于若随机数r处于第三区间Z,则选取第三采样策略作为执行策略;The third selection strategy unit is configured to select the third sampling strategy as the execution strategy if the random number r is in the third interval Z;
    其中,
    Figure PCTCN2020120756-appb-100002
    X∪Y∪Z=W。
    in,
    Figure PCTCN2020120756-appb-100002
    X∪Y∪Z=W.
  10. 如权利要求9所述的应用于路径规划的空间采样装置,其中,W=[0,1],所述第一区间X为[0,r a),所述第二区间Y为[r a,r b),所述第三区间Z为[r b,1],r a、r b为超参数,且0<r a<r b<1。 Space sampling applied to path planning apparatus according to claim 9, wherein, W = [0,1], X is the first interval [0, r a), said second section is Y [r a , r b), the third zone Z is [r b, 1], r a, r b is the hyper-parameters, and 0 <r a <r b < 1.
  11. 一种计算机设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机可读指令,其中,其中,所述处理器执行所述计算机可读指令时实现如下步骤:A computer device includes a memory, a processor, and computer readable instructions stored in the memory and capable of running on the processor, wherein, when the processor executes the computer readable instructions, the following is achieved step:
    通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内; Determine the effective point set S G of the state space S by a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q through the first mapping relationship;
    根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一 采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样; According to a preset random selection rule, a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy. The first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
    按照所述执行策略进行采样。Sampling is performed according to the described execution strategy.
  12. 如权利要求11所述的计算机设备,其中,所述通过预采样方法确定状态空间S的有效点集S G,包括: The computer device according to claim 11, wherein said determining the effective point set S G of the state space S by the pre-sampling method comprises:
    在状态空间S的可行区域S L均匀取样,得到点集S LPSampling uniformly in the feasible region S L of the state space S to obtain the point set S LP ;
    根据所述第一映射关系将所述点集S LP映射到状态空间Q,获得点集Q LP Map the point set S LP to the state space Q according to the first mapping relationship to obtain the point set Q LP ;
    从所述点集Q LP中选取处于所述可行区域Q L内的点,获得点集Q ASelect a point in the feasible region Q L from the point set Q LP to obtain a point set Q A ;
    在所述点集S LP中选取与所述点集Q A对应的点,生成点集S A,所述有效点集S G包括所述点集S ASelecting the set of points in S LP set of points Q A and the corresponding points, generating a set point S A, the active point set comprising the set of points S G S A.
  13. 如权利要求11所述的计算机设备,其中,所述通过预采样方法确定状态空间S的有效点集S G,包括: The computer device according to claim 11, wherein said determining the effective point set S G of the state space S by the pre-sampling method comprises:
    在状态空间Q的可行区域Q L均匀取样,得到点集Q LTSampling uniformly in the feasible region Q L of the state space Q to obtain the point set Q LT ;
    根据第二映射关系将所述点集Q LT映射到状态空间S,获得点集S LT Map the point set Q LT to the state space S according to the second mapping relationship to obtain the point set S LT ;
    从所述点集S LT中选取处于所述可行区域S L内的点,获得点集S QA,所述有效点集S G包括所述点集S QAA point within the feasible region SL is selected from the point set S LT to obtain a point set S QA , and the effective point set S G includes the point set S QA .
  14. 如权利要求11所述的计算机设备,其中,所述根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,包括:11. The computer device according to claim 11, wherein said selecting a sampling strategy from a specified number of sampling strategies as an execution strategy according to a preset random selection rule comprises:
    随机生成随机数r,随机数r的取值区间为W;Randomly generate random number r, the value range of random number r is W;
    若随机数r处于第一区间X,则选取第一采样策略作为执行策略;If the random number r is in the first interval X, the first sampling strategy is selected as the execution strategy;
    若随机数r处于第二区间Y,则选取第二采样策略作为执行策略;If the random number r is in the second interval Y, the second sampling strategy is selected as the execution strategy;
    若随机数r处于第三区间Z,则选取第三采样策略作为执行策略;If the random number r is in the third interval Z, the third sampling strategy is selected as the execution strategy;
    其中,
    Figure PCTCN2020120756-appb-100003
    X∪Y∪Z=W。
    in,
    Figure PCTCN2020120756-appb-100003
    X∪Y∪Z=W.
  15. 如权利要求14所述的计算机设备,其中,W=[0,1],所述第一区间X为[0,r a),所述第二区间Y为[r a,r b),所述第三区间Z为[r b,1],r a、r b为超参数,且0<r a<r b<1。 The computer apparatus according to claim 14, wherein, W = [0,1], X is the first interval [0, r a), said second section is Y [r a, r b), the said third zone Z is [r b, 1], r a, r b is the hyper-parameters, and 0 <r a <r b < 1.
  16. 一个或多个存储有计算机可读指令的可读存储介质,所述计算机可读指令被一个或多个处理器执行时,使得所述一个或多个处理器执行如下步骤:One or more readable storage media storing computer readable instructions, when the computer readable instructions are executed by one or more processors, the one or more processors execute the following steps:
    通过预采样方法确定状态空间S的有效点集S G,所述有效点集S G中的任意一点,经第一映射关系映射在状态空间Q的可行区域Q L内; Determine the effective point set S G of the state space S by a pre-sampling method, and any point in the effective point set S G is mapped into the feasible region Q L of the state space Q through the first mapping relationship;
    根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域S L进行采样;第二采样策略是指在所述有效点集S G进行采样;第三采样策略是指先在有效点集S G随机选取点B,再在点B的指定范围内选取属于所述有效点集S G的点C,在点B与点C之间任意一点进行采样; According to a preset random selection rule, a sampling strategy is selected from a specified number of sampling strategies as the execution strategy, and the specified number of sampling strategies includes at least a first sampling strategy, a second sampling strategy, and a third sampling strategy. The first sampling strategy refers to sampling in the feasible region SL of the state space S; the second sampling strategy refers to sampling in the effective point set S G ; the third sampling strategy refers to randomly selecting points in the effective point set S G B. Then select a point C belonging to the effective point set S G within the specified range of the point B, and perform sampling at any point between the point B and the point C;
    按照所述执行策略进行采样。Sampling is performed according to the described execution strategy.
  17. 如权利要求16所述的可读存储介质,其中,所述通过预采样方法确定状态空间S的有效点集S G,包括: The readable storage medium according to claim 16, wherein the determining the effective point set S G of the state space S by the pre-sampling method comprises:
    在状态空间S的可行区域S L均匀取样,得到点集S LPSampling uniformly in the feasible region S L of the state space S to obtain the point set S LP ;
    根据所述第一映射关系将所述点集S LP映射到状态空间Q,获得点集Q LP Map the point set S LP to the state space Q according to the first mapping relationship to obtain the point set Q LP ;
    从所述点集Q LP中选取处于所述可行区域Q L内的点,获得点集Q ASelect a point in the feasible region Q L from the point set Q LP to obtain a point set Q A ;
    在所述点集S LP中选取与所述点集Q A对应的点,生成点集S A,所述有效点集S G包括所述点集S ASelecting the set of points in S LP set of points Q A and the corresponding points, generating a set point S A, the active point set comprising the set of points S G S A.
  18. 如权利要求16所述的可读存储介质,其中,所述通过预采样方法确定状态空间S的有效点集S G,包括: The readable storage medium according to claim 16, wherein the determining the effective point set S G of the state space S by the pre-sampling method comprises:
    在状态空间Q的可行区域Q L均匀取样,得到点集Q LTSampling uniformly in the feasible region Q L of the state space Q to obtain the point set Q LT ;
    根据第二映射关系将所述点集Q LT映射到状态空间S,获得点集S LT Map the point set Q LT to the state space S according to the second mapping relationship to obtain the point set S LT ;
    从所述点集S LT中选取处于所述可行区域S L内的点,获得点集S QA,所述有效点集S G包括所述点集S QAA point within the feasible region SL is selected from the point set S LT to obtain a point set S QA , and the effective point set S G includes the point set S QA .
  19. 如权利要求16所述的可读存储介质,其中,所述根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,包括:15. The readable storage medium of claim 16, wherein the selecting a sampling strategy from a specified number of sampling strategies as the execution strategy according to a preset random selection rule comprises:
    随机生成随机数r,随机数r的取值区间为W;Randomly generate random number r, the value range of random number r is W;
    若随机数r处于第一区间X,则选取第一采样策略作为执行策略;If the random number r is in the first interval X, the first sampling strategy is selected as the execution strategy;
    若随机数r处于第二区间Y,则选取第二采样策略作为执行策略;If the random number r is in the second interval Y, the second sampling strategy is selected as the execution strategy;
    若随机数r处于第三区间Z,则选取第三采样策略作为执行策略;If the random number r is in the third interval Z, the third sampling strategy is selected as the execution strategy;
    其中,
    Figure PCTCN2020120756-appb-100004
    X∪Y∪Z=W。
    in,
    Figure PCTCN2020120756-appb-100004
    X∪Y∪Z=W.
  20. 如权利要求19所述的可读存储介质,其中,W=[0,1],所述第一区间X为[0,r a),所述第二区间Y为[r a,r b),所述第三区间Z为[r b,1],r a、r b为超参数,且0<r a<r b<1。 Readable storage medium according to claim 19, wherein, W = [0,1], X is the first interval [0, r a), said second section is Y [r a, r b) the third section is Z [r b, 1], r a, r b is the hyper-parameters, and 0 <r a <r b < 1.
PCT/CN2020/120756 2020-07-31 2020-10-14 Spatial sampling method, apparatus, device, and medium applied to path planning WO2021164277A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202010763143.3A CN111906765B (en) 2020-07-31 2020-07-31 Space sampling method, device, equipment and medium applied to path planning
CN202010763143.3 2020-07-31

Publications (1)

Publication Number Publication Date
WO2021164277A1 true WO2021164277A1 (en) 2021-08-26

Family

ID=73287586

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2020/120756 WO2021164277A1 (en) 2020-07-31 2020-10-14 Spatial sampling method, apparatus, device, and medium applied to path planning

Country Status (2)

Country Link
CN (1) CN111906765B (en)
WO (1) WO2021164277A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117553820A (en) * 2024-01-12 2024-02-13 北京理工大学 Path planning method, system and equipment in off-road environment

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115990875B (en) * 2022-11-10 2024-05-07 华南理工大学 Flexible cable state prediction and control system based on hidden space interpolation

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106695802A (en) * 2017-03-19 2017-05-24 北京工业大学 Improved RRT<*> obstacle avoidance motion planning method based on multi-degree-of-freedom mechanical arm
CN109807886A (en) * 2019-01-15 2019-05-28 西北工业大学 A kind of space non-cooperative target based on prediction arrests strategy
CN110653805A (en) * 2019-10-10 2020-01-07 西安科技大学 Task constraint path planning method for seven-degree-of-freedom redundant manipulator in Cartesian space
CN110986953A (en) * 2019-12-13 2020-04-10 深圳前海达闼云端智能科技有限公司 Path planning method, robot and computer readable storage medium
CN111251306A (en) * 2020-03-18 2020-06-09 广东省智能机器人研究院 Mechanical arm path planning method with chassis error

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100941418B1 (en) * 2007-03-20 2010-02-11 삼성전자주식회사 A localization method of moving robot
CN100529766C (en) * 2007-10-17 2009-08-19 电子科技大学 Equivalent sampling device
CN104155974B (en) * 2013-07-29 2017-05-17 深圳信息职业技术学院 Path planning method and apparatus for robot fast collision avoidance
JP2015147256A (en) * 2014-02-04 2015-08-20 セイコーエプソン株式会社 Robot, robot system, control device, and control method
CN105246121B (en) * 2015-09-30 2018-10-26 西北大学 A kind of variable dimension population construction method of mobile sink information collection pathway
CN106569496B (en) * 2016-11-14 2021-07-23 中国船舶工业集团公司第七0八研究所 Planning method of motion path
US10012988B2 (en) * 2016-11-29 2018-07-03 Mitsubishi Electric Research Laboratories, Inc. Methods and systems for path planning using a network of safe-sets
CN107677285B (en) * 2017-04-11 2019-05-28 平安科技(深圳)有限公司 The path planning system and method for robot
CN108582073B (en) * 2018-05-02 2020-09-15 北京邮电大学 Mechanical arm rapid obstacle avoidance method based on improved random road marking map method
CN109521774B (en) * 2018-12-27 2023-04-07 南京芊玥机器人科技有限公司 Spraying robot track optimization method based on reinforcement learning
CN109887012B (en) * 2019-01-09 2023-03-31 天津大学 Point cloud registration method combined with self-adaptive search point set
CN111340875B (en) * 2020-02-17 2023-04-07 南京航空航天大学 Space moving target detection method based on three-dimensional laser radar

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106695802A (en) * 2017-03-19 2017-05-24 北京工业大学 Improved RRT<*> obstacle avoidance motion planning method based on multi-degree-of-freedom mechanical arm
CN109807886A (en) * 2019-01-15 2019-05-28 西北工业大学 A kind of space non-cooperative target based on prediction arrests strategy
CN110653805A (en) * 2019-10-10 2020-01-07 西安科技大学 Task constraint path planning method for seven-degree-of-freedom redundant manipulator in Cartesian space
CN110986953A (en) * 2019-12-13 2020-04-10 深圳前海达闼云端智能科技有限公司 Path planning method, robot and computer readable storage medium
CN111251306A (en) * 2020-03-18 2020-06-09 广东省智能机器人研究院 Mechanical arm path planning method with chassis error

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117553820A (en) * 2024-01-12 2024-02-13 北京理工大学 Path planning method, system and equipment in off-road environment
CN117553820B (en) * 2024-01-12 2024-04-05 北京理工大学 Path planning method, system and equipment in off-road environment

Also Published As

Publication number Publication date
CN111906765A (en) 2020-11-10
CN111906765B (en) 2022-07-12

Similar Documents

Publication Publication Date Title
WO2021164277A1 (en) Spatial sampling method, apparatus, device, and medium applied to path planning
WO2021114625A1 (en) Network structure construction method and apparatus for use in multi-task scenario
US20180096249A1 (en) Convolutional neural network system using adaptive pruning and weight sharing and operation method thereof
US20180024966A1 (en) Autonomous memory architecture
US9015440B2 (en) Autonomous memory subsystem architecture
US20210025712A1 (en) Method for correcting gyroscope data of mobile robot, device, and storage medium
WO2023116314A1 (en) Neural network acceleration apparatus and method, and device and computer storage medium
CN102420771B (en) Method for increasing concurrent transmission control protocol (TCP) connection speed in high-speed network environment
CN111598213B (en) Network training method, data identification method, device, equipment and medium
WO2022016926A1 (en) Neural network computing apparatus and data reading and data storage method and related device
CN112731961A (en) Path planning method, device, equipment and storage medium
Zhao et al. Improved manipulator obstacle avoidance path planning based on potential field method
WO2023178793A1 (en) Method and apparatus for training dual-perspective graph neural network model, device, and medium
CN110322477B (en) Feature point observation window setting method, tracking method, device, equipment and medium
CN117312330B (en) Vector data aggregation method and device based on note storage and computer equipment
WO2022126352A1 (en) Robot obstacle avoidance method and apparatus, robot, and storage medium
Saputra et al. A swarm optimization approach for solving workspace determination of parallel manipulators
CN112966054A (en) Enterprise graph node relation-based ethnic group division method and computer equipment
CN113612863B (en) Method, system, equipment and storage medium for optimizing address conversion in GPU
US20220396431A1 (en) Method for determining material-cage stacking, computer device, and storage medium
WO2022120670A1 (en) Movement trajectory planning method and apparatus for mechanical arm, and mechanical arm and storage medium
CN115456149A (en) Method, device, terminal and storage medium for learning pulse neural network accelerator
CN114489043B (en) Multi-agent path planning method and device, electronic equipment and storage medium
CN113733104B (en) Control method of mechanical arm, computer equipment and storage medium
CN113642592B (en) Training method of training model, scene recognition method and computer equipment

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: 20920294

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

32PN Ep: public notification in the ep bulletin as address of the adressee cannot be established

Free format text: NOTING OF LOSS OF RIGHTS PURSUANT TO RULE 112(1) EPC (EPO FORM 1205A DATED 04/05/2023)

122 Ep: pct application non-entry in european phase

Ref document number: 20920294

Country of ref document: EP

Kind code of ref document: A1