# US 2026/0227796 A1 · Systems and methods for path planning

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2026/0227796 A1
- Document ID: US20260227796A1
- Status: Published application
- Kind: A1
- Application number: 19/630,498
- Filed: 2026-03-27
- Published: 2026-08-06
- Earliest claimed: 2023-09-28
- Assignees: Zhejiang Huaray Technology Co., Ltd.
- Applicants: Zhejiang Huaray Technology Co., Ltd.
- Inventors: Yidong JIN; Jiangtao CHEN; Wei LU
- Web page: https://patentgrep.com/patent/US20260227796A1

## CPC

- G01C 21/20: Instruments for performing navigational calculations (G01C21/24, G01C21/26 take precedence)
- G05D 1/644: Optimisation of travel parameters, e.g. of energy consumption, journey time or distance
- G05D 1/246: using environment maps, e.g. simultaneous localisation and mapping [SLAM]
- G05D 2109/10: Land vehicles
- Y02D 30/70: in wireless communication networks
- G01C: MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY (measuring liquid level G01F; radio navigation, determining distance or velocity by use of propagation effects, e.g. Doppler effects, propagation time, of radio waves, analogous arrangements using other waves G01S)
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- Y02D: CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE

## Abstract

The present disclosure provides methods and systems for path planning. The methods may include obtaining posture information of a moveable subject and a path map. The moveable subject may be located at a current position in the path map and plan to go to a target position in the path map, the path map may include path nodes and path segments, and each of the path segments may connect two path nodes of the path nodes. The methods may include determining, based on the posture information of the moveable subject, one or more target path segments from the path segments in the path map. The methods may also include determining one or more candidate starting nodes based on the one or more target path segments. The methods may further include determining a target starting node from the one or more candidate starting nodes.

## Claims

### Claim 1

A method for path planning, implemented on a computing device having at least one processor and at least one storage device, the method comprising:
obtaining posture information of a moveable subject and a path map, the moveable subject being located at a current position in the path map and planning to go to a target position in the path map, the path map including path nodes and path segments, and each of the path segments connecting two path nodes of the path nodes;
determining, based on the posture information of the moveable subject, one or more target path segments from the path segments in the path map, wherein a first travel cost from the current position of the moveable subject to each of the one or more target path segments satisfies a first condition;
determining one or more candidate starting nodes based on the one or more target path segments; and
determining a target starting node from the one or more candidate starting nodes, a second travel cost from the target starting node to the target position satisfying a second condition.

### Claim 2 (depends on 1)

The method of claim 1, wherein the determining, based on the posture information of the moveable subject, one or more target path segments from the path segments in the path map includes:
determining, based on the posture information of the moveable subject, a path node range in the path map;
determining one or more candidate path segments from the path segments, each of the one or more candidate path segments including at least one path node within the path node range; and
selecting the one or more target path segments from the one or more candidate path segments.

### Claim 3 (depends on 2)

The method of claim 2, wherein the selecting the one or more target path segments from the one or more candidate path segments includes:
for each of the one or more candidate path segments,
determining, based on the posture information of the moveable subject, a first travel cost from the current position to the candidate path segment;
determining whether the first travel cost of the candidate path segment satisfies the first condition; and
in response to determining that the first travel cost of the candidate path segment satisfies the first condition, designating the candidate path segment as one of the one or more target path segments.

### Claim 4 (depends on 3)

The method of claim 3, wherein the determining the first travel cost from the current position to the candidate path segment includes:
determining, based on the posture information of the moveable subject, a distance cost relating to a distance between the current position and the candidate path segment;
determining, based on the posture information of the moveable subject, an angle cost relating to an angle between an orientation of the moveable subject and an orientation of the candidate path segment; and
determining, based on the distance cost and the angle cost, the first travel cost from the current position to the candidate path segment.

### Claim 5 (depends on 4)

The method of claim 4, wherein the determining, based on the distance cost and the angle cost, the first travel cost from the current position to the candidate path segment includes:
transforming the angle cost into a second distance cost; and
determining the first travel cost based on the distance cost and the second distance cost.

### Claim 6 (depends on 4)

The method of claim 4, wherein the determining the first travel cost from the current position to the candidate path segment includes:
obtaining sensing data captured by one or more sensors mounted on the moveable subject;
determining whether there is a roadblock along a path from the current position to the candidate path segment based on the sensing data;
in response to determining that there is a roadblock along the path, updating the distance cost and the angle cost;
determining the first travel cost from the current position to the candidate path segment based on the updated distance cost and the updated angle cost.

### Claim 7 (depends on 3)

The method of claim 3, wherein the selecting the one or more target path segments from the one or more candidate path segments further includes:
for each of the one or more candidate path segments,
determining a third travel cost from the current position to each path node in the candidate path segment; and
determining whether the third travel cost from the current position to each path node in the candidate path segment satisfies a third condition, wherein the in response to determining that the first travel cost of the candidate path segment satisfies the first condition, designating the candidate path segment as one of the one or more target path segments includes:
in response to determining that the first travel cost of the candidate path segment satisfies the first condition and the third travel cost from the current position to each path node in the candidate path segment satisfies the third condition, designating the candidate path segment as one of the one or more target path segments.

### Claim 8 (depends on 1)

The method of claim 1, wherein the determining one or more target path segments from the path segments in the path map includes:
selecting one or more path nodes from the path nodes in the path map, wherein each selected path node has no accessible path to the target position;
obtaining a filtered path map by removing the one or more selected path nodes from the path map; and
determining the one or more target path segments from the path segments in the filtered path map based on the posture information of the moveable subject.

### Claim 9 (depends on 1)

The method of claim 1, wherein the one or more candidate starting nodes include multiple candidate starting nodes, and the target starting node is determined from the multiple candidate starting nodes by:
determining a fourth travel cost from the current position to each candidate starting node;
determining a node sequence by sorting the candidate starting nodes based on the fourth travel costs; and
sequentially processing the candidate starting nodes in the node sequence until a second travel cost from the currently processed candidate starting node to the target position satisfies the second condition.

### Claim 10 (depends on 1)

The method of claim 1, wherein the one or more candidate starting nodes include multiple candidate starting nodes, and the target starting node is determined from the multiple candidate starting nodes by:
for each of the multiple candidate starting nodes,
determining whether there is an accessible path from the candidate starting node to the target position;
in response to determining that there is an accessible path from the candidate starting node to the target position, determining a second travel cost from the candidate starting node to the target position based on a planned path from the candidate starting node to the target position based on the path map; and
determining the target starting node from the multiple candidate starting nodes based on the second travel costs of the multiple candidate starting nodes.

### Claim 11 (depends on 10)

The method of claim 10, wherein the planned path includes multiple planned path segments, and the determining the second travel cost from the candidate starting node to the target position comprises:
obtaining reference information relating to the multiple planned path segments;
determining an accessible probability of each of the multiple planned path segments based on the reference information;
updating the planned path based on the accessible probability of each of the multiple planned path segments; and
determining the second travel cost based on the updated planned path.

### Claim 12 (depends on 10)

The method of claim 10, wherein the determining the target starting node from the multiple candidate starting nodes includes:
for each of the multiple candidate starting nodes,
determining a fourth travel cost from the current position to the candidate starting node; and
determining a total travel cost corresponding to the candidate starting node based on the second travel cost and the fourth travel cost of the candidate starting node; and
designating the candidate starting node having the lowest total travel cost as the target starting node.

### Claim 13

A system for path planning, comprising:
at least one storage device including a set of instructions; and
at least one processor configured to communicate with the at least one storage device, wherein when executing the set of instructions, the at least one processor is configured to direct the system to perform operations including:
obtaining posture information of a moveable subject and a path map, the moveable subject being located at a current position in the path map and planning to go to a target position in the path map, the path map including path nodes and path segments, and each of the path segments connecting two path nodes of the path nodes;
determining, based on the posture information of the moveable subject, one or more target path segments from the path segments in the path map, wherein a first travel cost from the current position of the moveable subject to each of the one or more target path segments satisfies a first condition;
determining one or more candidate starting nodes based on the one or more target path segments; and
determining a target starting node from the one or more candidate starting nodes, a second travel cost from the target starting node to the target position satisfying a second condition.

### Claim 14 (depends on 13)

The system of claim 13, wherein the determining, based on the posture information of the moveable subject, one or more target path segments from the path segments in the path map includes:
determining, based on the posture information of the moveable subject, a path node range in the path map;
determining one or more candidate path segments from the path segments, each of the one or more candidate path segments including at least one path node within the path node range; and
selecting the one or more target path segments from the one or more candidate path segments.

### Claim 15 (depends on 14)

The system of claim 14, wherein the selecting the one or more target path segments from the one or more candidate path segments includes:
for each of the one or more candidate path segments,
determining, based on the posture information of the moveable subject, a first travel cost from the current position to the candidate path segment;
determining whether the first travel cost of the candidate path segment satisfies the first condition; and
in response to determining that the first travel cost of the candidate path segment satisfies the first condition, designating the candidate path segment as one of the one or more target path segments.

### Claim 16 (depends on 15)

The system of claim 15, wherein the determining the first travel cost from the current position to the candidate path segment includes:
determining, based on the posture information of the moveable subject, a distance cost relating to a distance between the current position and the candidate path segment;
determining, based on the posture information of the moveable subject, an angle cost relating to an angle between an orientation of the moveable subject and an orientation of the candidate path segment; and
determining, based on the distance cost and the angle cost, the first travel cost from the current position to the candidate path segment.

### Claim 17 (depends on 16)

The system of claim 16, wherein the determining, based on the distance cost and the angle cost, the first travel cost from the current position to the candidate path segment includes:
transforming the angle cost into a second distance cost; and
determining the first travel cost based on the distance cost and the second distance cost.

### Claim 18 (depends on 16)

The system of claim 16, wherein the determining the first travel cost from the current position to the candidate path segment includes:
obtaining sensing data captured by one or more sensors mounted on the moveable subject;
determining whether there is a roadblock along a path from the current position to the candidate path segment based on the sensing data;
in response to determining that there is a roadblock along the path, updating the distance cost and the angle cost;
determining the first travel cost from the current position to the candidate path segment based on the updated distance cost and the updated angle cost.

### Claim 19 (depends on 15)

The system of claim 15, wherein the selecting the one or more target path segments from the one or more candidate path segments further includes:
for each of the one or more candidate path segments,
determining a third travel cost from the current position to each path node in the candidate path segment; and
determining whether the third travel cost from the current position to each path node in the candidate path segment satisfies a third condition, wherein the in response to determining that the first travel cost of the candidate path segment satisfies the first condition, designating the candidate path segment as one of the one or more target path segments includes:
in response to determining that the first travel cost of the candidate path segment satisfies the first condition and the third travel cost from the current position to each path node in the candidate path segment satisfies the third condition, designating the candidate path segment as one of the one or more target path segments.

### Claim 20

A non-transitory computer readable medium, comprising executable instructions that, when executed by at least one processor, direct the at least one processor to perform a method, the method comprising:
obtaining posture information of a moveable subject and a path map, the moveable subject being located at a current position in the path map and planning to go to a target position in the path map, the path map including path nodes and path segments, and each of the path segments connecting two path nodes of the path nodes;
determining, based on the posture information of the moveable subject, one or more target path segments from the path segments in the path map, wherein a first travel cost from the current position of the moveable subject to each of the one or more target path segments satisfies a first condition;
determining one or more candidate starting nodes based on the one or more target path segments; and
determining a target starting node from the one or more candidate starting nodes, a second travel cost from the target starting node to the target position satisfying a second condition.
