# US 2022/0019226 A1 · System and Method for Navigating a Turn by an Autonomous Vehicle

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

- Number: US 2022/0019226 A1
- Document ID: US20220019226A1
- Status: Published application
- Kind: A1
- Application number: 17/214,045
- Filed: 2021-03-26
- Published: 2022-01-20
- Earliest claimed: 2020-07-17
- Assignees: DEKA Products Limited Partnership
- Applicants: DEKA Products Limited Partnership
- Inventors: Siyuan Huang
- Web page: https://patentgrep.com/patent/US20220019226A1

## CPC

- G05D 1/0212: {with means for defining a desired trajectory (involving a plurality of land vehicles G05D1/0287)}
- G05D 1/0214: {in accordance with safety or protection criteria, e.g. avoiding hazardous areas (monitoring the location of vehicles within a certain area, e.g. forbidden or allowed areas, in traffic control systems for road vehicles G08G1/13)}
- B62D 15/0265: {Automatic obstacle avoidance by steering}
- G05D 1/024: {in combination with a laser (lasers per se H01S)}
- G05D 1/0248: {in combination with a laser (lasers per se H01S)}
- G05D 1/247: using signals provided by artificial sources external to the vehicle, e.g. navigation beacons
- G05D 1/617: Safety or protection, e.g. defining protection zones around obstacles or avoiding hazards (arrangements for controlling the position or course of two or more vehicles for avoiding collisions therebetween G05D1/693; arrangements for reacting to or preventing system or operator failure G05D1/80)
- G05D 1/646: Following a predefined trajectory, e.g. a line marked on the floor or a flight path
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- B62D: MOTOR VEHICLES; TRAILERS (steering, or guiding on a desired track, of agricultural machines or implements A01B69/00; wheels, castors, axles, increasing wheel adhesion B60B; vehicle tyres, tyre inflation or tyre changing B60C; connections between vehicles of a train or the like B60D; vehicles for use on rail and road, amphibious or convertible vehicles B60F; suspension arrangements B60G; heating, cooling, ventilating or other air treating devices B60H; windows, windscreens, non-fixed roofs, doors or similar devices, protective coverings for vehicles not in use B60J; propulsion plant arrangements, auxiliary drives, transmissions, controls, instrumentation or dashboards B60K; electric equipment or propulsion of electrically-propelled vehicles B60L; power supply for electrically-propelled vehicles B60M; passenger accommodation not otherwise provided for B60N; adaptations for load transportation or to carry special loads or objects B60P; arrangement of signalling or lighting devices, the mounting or supporting thereof or circuits therefor, for vehicles in general B60Q; vehicles, vehicle fittings or vehicle parts not otherwise provided for B60R; servicing, cleaning, repairing, supporting, lifting, or manoeuvring, not otherwise provided for, B60S; brake arrangements, brake control systems or parts thereof B60T; air-cushion vehicles B60V; motor-cycles, accessories therefor B62J, B62K; testing of vehicles G01M)

## Abstract

Spin controller that can enable an autonomous vehicle (AV) to spin in place. A model predictive controller (MPC) can trigger the spin controller any time the MPC determines that a spin in place is required. In some configurations, the spin controller can move the AV to within 5° of the destination point. Spin controller can determine spin method based on the configuration of the AV, calculate an optimum turning path based at least on device mode and obstacles, and can enable the AV to spin in place.

## Claims

### Claim 1

A method for spinning an autonomous device (AV) in place comprising:
(a) receiving a mode of the AV and coordinates of a destination to which the AV is headed;
(b) determining an axis of rotation of the AV based on the mode;
(c) determining a clockwise rotation angle α and a counterclockwise rotation angle β between a current heading of the AV and the destination;
(d) setting a rotation direction of the AV to counterclockwise if α≥β, and setting the rotation direction to clockwise if α<β;
(e) determining a path to reach the destination;
(f) enabling the AV to travel along the path;
(g) if the AV is at the destination, returning to (a); and
(h) if the AV is not at the destination, returning to (b).

### Claim 2 (depends on 1)

The method as in claim 1 wherein determining the path to reach the destination comprises:
(i) determining a first length of a first line between the axis of rotation and a first corner a 2D depiction of the AV;
(j) drawing a second line of the first length, the second line beginning at the axis of rotation and extending, perpendicularly, through a first boundary of the 2D depiction of the AV;
(k) determining a second length of a third line between the axis of rotation and a second corner of the 2D depiction of the AV;
(l) drawing a fourth line of the second length, the fourth line beginning at the axis of rotation and extending, perpendicularly, through a second boundary of the 2D depiction of the AV;
(m) drawing a first polygon around the 2D depiction of the AV, the first polygon including two opposing sides, each of the two opposing sides being a third length equaling a summation of the first length and the second length, the including the first boundary and the second boundary, the first boundary and the second boundary connecting opposing ends of the two opposing sides, the first polygon including a leading corner of the 2D depiction of the AV, the leading corner being chosen based on the rotation direction; and
(n) creating the path by laying lines a fourth length of the first boundary end to end between the AV and the destination;
(o) determining a second polygon based on turn points;
(p) accessing an occupancy grid spatially coinciding with the second polygon;
(q) determining obstacles within the second polygon based on the occupancy grid; and
(r) if the obstacles are found in the second polygon, changing the rotation direction and returning to (n).

### Claim 3 (depends on 1)

The method as in claim 1 wherein the mode comprises:
at least one configuration of the AV.

### Claim 4 (depends on 1)

The method as in claim 1 wherein the mode comprises:
at least one configuration of wheels of the AV.

### Claim 5 (depends on 1)

The method as in claim 1 wherein the mode comprises:
all drive wheels of the AV in contact with a surface.

### Claim 6 (depends on 1)

The method as in claim 1 wherein the mode comprises:
a subset of drive wheels of the AV in contact with a surface.

### Claim 7 (depends on 1)

The method as in claim 1 wherein the occupancy grid comprises:
occupancy data based on data from sensors mounted upon the AV.

### Claim 8 (depends on 1)

The method as in claim 1 wherein the occupancy grid comprises:
occupancy data based on LIDAR sensors mounted upon the AV.

### Claim 9 (depends on 1)

The method as in claim 1 wherein the occupancy grid comprises:
occupancy data based on at least one camera mounted upon the AV.

### Claim 10 (depends on 1)

The method as in claim 1 wherein the occupancy grid comprises:
occupancy data based a combination of LIDAR sensors, cameras, radar, and sonar mounted upon the AV.

### Claim 11

A system for spinning an autonomous device (AV) in place comprising:
a processor executing instructions including:
(a) receiving a mode of the AV and coordinates of a destination to which the AV is headed;
(b) determining an axis of rotation of the AV based on the mode;
a turn processor executing instructions including:
(c) determining a clockwise rotation angle α and a counterclockwise rotation angle β between a current heading of the AV and the destination; and
(d) setting a rotation direction of the AV to counterclockwise if α≥β, and setting the rotation direction to clockwise if α<β;
a path processor executing instructions including:
(e) determining a path to reach the destination including:
(f) enabling the AV to travel along the path;
(g) if the AV is at the destination, returning to (a); and
(h) if the AV is not at the destination, returning to (b).

### Claim 12 (depends on 11)

The system as in claim 11 wherein determining the path to reach the destination comprises:
the processor executing instructions including:
(i) determining a first length of a first line between the axis of rotation and a first corner a 2D depiction of the AV;
(j) drawing a second line of the first length, the second line beginning at the axis of rotation and extending, perpendicularly, through a first boundary of the 2D depiction of the AV;
(k) determining a second length of a third line between the axis of rotation and a second corner of the 2D depiction of the AV;
(l) drawing a fourth line of the second length, the fourth line beginning at the axis of rotation and extending, perpendicularly, through a second boundary of the 2D depiction of the AV;
(m) drawing a first polygon around the 2D depiction of the AV, the first polygon including two opposing sides, each of the two opposing sides being a third length equaling a summation of the first length and the second length, the including the first boundary and the second boundary, the first boundary and the second boundary connecting opposing ends of the two opposing sides, the first polygon including a leading corner of the 2D depiction of the AV, the leading corner being chosen based on the rotation direction;
(n) creating the path by laying lines a fourth length of the first boundary end to end between the AV and the destination;
(o) determining a second polygon based on turn points;
(p) accessing an occupancy grid spatially coinciding with the second polygon;
(q) determining obstacles within the second polygon based on the occupancy grid; and
(r) if the obstacles are found in the second polygon, changing the rotation direction and returning to (n).

### Claim 13 (depends on 11)

The system as in claim 11 wherein the mode comprises:
at least one configuration of the AV.

### Claim 14 (depends on 11)

The system as in claim 11 wherein the mode comprises:
at least one configuration of wheels of the AV.

### Claim 15 (depends on 11)

The system as in claim 11 wherein the mode comprises:
all drive wheels of the AV in contact with a surface.

### Claim 16 (depends on 11)

The system as in claim 11 wherein the mode comprises:
a subset of drive wheels of the AV in contact with a surface.

### Claim 17 (depends on 11)

The system as in claim 11 wherein the occupancy grid comprises:
occupancy data based on data from sensors mounted upon the AV.

### Claim 18 (depends on 11)

The system as in claim 11 wherein the occupancy grid comprises:
occupancy data based on LIDAR sensors mounted upon the AV.

### Claim 19 (depends on 11)

The system as in claim 11 wherein the occupancy grid comprises:
occupancy data based on at least one camera mounted upon the AV.

### Claim 20 (depends on 11)

The system as in claim 11 wherein the occupancy grid comprises:
occupancy data based a combination of LIDAR sensors, cameras, radar, and sonar mounted upon the AV.
