Patent ID: 11906314
Assignee: NEC CORPORATION
Field: Measurement (Instruments)
Classification: CPC G  B | IPC B  G

Claim 5:
6. A waypoint selection method comprising:
obtaining information related to a current pose of a vehicle including a combination of location and orientation relative to a reference axis;
obtaining information related to a destination pose of the vehicle including a combination of location and orientation relative to the reference axis;
obtaining a plurality of waypoints between the orientation of the vehicle at the location indicated by the current pose and the orientation of the vehicle at the location indicated by the destination pose;
obtaining obstacle information;
determining a first waypoint cost for a first waypoint, corresponding to an amount of movement for the vehicle to move from the orientation of the vehicle at the location indicated by the current pose to the orientation of the vehicle at the first waypoint, of the plurality of waypoints;
selecting the first waypoint in response to the first waypoint cost satisfying a predetermined condition;
generating a path from the current pose to the pose at the first waypoint in response to selecting the first waypoint;
outputting movement instructions to the vehicle for moving along the generated path: wherein determining the first waypoint cost comprising determining the first waypoint cost based on:
a path length ratio between (1) a direct path between the current pose and a pose at the first waypoint and (2) a calculated path between the current pose and the pose at the first waypoint;
a number of direction changes along the calculated path between the current pose and the pose at the first waypoint;
a heading angle from the current pose to the pose at the first waypoint;
an orientation difference between the current pose and the pose at the first waypoint, with the waypoint cost increasing as it approaches ninety degrees and decreasing as it approaches zero degrees or one hundred eighty degrees;
a proximity of a closest obstacle to the calculated path; and
a Euclidean distance between the current pose and the pose at the first waypoint.