# US 2022/0026908 A1 · Method and apparatus for positioning a robot at start-up, electronic device and storage medium

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

- Number: US 2022/0026908 A1
- Document ID: US20220026908A1
- Status: Published application
- Kind: A1
- Application number: 17/233,117
- Filed: 2021-04-16
- Published: 2022-01-27
- Earliest claimed: 2020-07-22
- Assignees: Keenon Robotics Co., Ltd.
- Applicants: Keenon Robotics Co., Ltd.
- Inventors: Shuai MA; Wenfei Zhao; Xue Bai; Yingxuan Li
- Web page: https://patentgrep.com/patent/US20220026908A1

## CPC

- G05D 1/0212: {with means for defining a desired trajectory (involving a plurality of land vehicles G05D1/0287)}
- G05D 1/0261: {using magnetic plots}
- G01S 5/02: using radio waves (using satellite radio beacon systems for determining position G01S19/00)
- G01S 5/0247: {Determining attitude}
- G01S 5/0284: {Relative positioning}
- G01S 5/14: Determining absolute distances from a plurality of spaced points of known location
- G01S 5/30: Determining absolute distances from a plurality of spaced points of known location
- G01S 2205/01: specially adapted for specific applications
- H04W 4/025: {using location based information parameters}
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G01S: RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- H04W: WIRELESS COMMUNICATION NETWORKS (broadcast communication H04H; communication systems using wireless links for non-selective communication, e.g. wireless extensions H04M1/72)

## Abstract

A method for positioning a robot at start-up includes: when the robot is started up, controlling the robot to rotate in a preset rotation direction in a start-up positioning region; determining position information about a rotation path of the positioning transmitting unit according to the preset rotation direction and a set of at least three different position distances, where the at least three different position distances are between the positioning transmitting unit and the two positioning receiving units disposed at the different fixed positions and are determined during a rotation process; using a direction extending from the center position of the rotation path to a position of the positioning transmitting unit when the robot stops rotation as orientation information of the robot; and using the center position of the rotation path and the orientation information of the robot as start-up positioning information of the robot.

## Claims

### Claim 1

A method for positioning a robot at start-up, executed by a controller in a system for positioning a robot at start-up, wherein the system for positioning a robot at start-up comprises two positioning receiving units disposed at different fixed positions and a positioning transmitting unit disposed on the robot, the positioning transmitting unit is in communication connection with the positioning receiving units and is configured to send positioning signals to the positioning receiving units, and the method comprises:
when the robot is started up, controlling the robot to rotate in a preset rotation direction in a start-up positioning region;
determining position information about a rotation path of the positioning transmitting unit according to the preset rotation direction and a set of at least three different position distances, wherein the at least three different position distances are between the positioning transmitting unit and the two positioning receiving units and determined during a rotation process;
determining a center position of the rotation path according to the position information about the rotation path of the positioning transmitting unit;
using a direction extending from the center position of the rotation path to a position of the positioning transmitting unit when the robot stops rotation as orientation information of the robot; and
using the center position of the rotation path and the orientation information of the robot as start-up positioning information of the robot.

### Claim 2 (depends on 1)

The method of claim 1, wherein distances between the start-up positioning region and the positioning receiving units are less than a preset distance threshold.

### Claim 3 (depends on 1)

The method of claim 1, wherein determining the position information about the rotation path of the positioning transmitting unit comprises:
determining two mirror rotation paths of the positioning transmitting unit according to the set of the at least three different position distances;
acquiring position coordinates of three non-collinear points on each of the two mirror rotation paths according to a rotation sequence;
determining an area vector formed by the three non-collinear points on each of the two mirror rotation paths, and obtaining a calculated rotation direction of the robot according to a numerical value of the area vector; and
determining the position information about the rotation path of the positioning transmitting unit according to the numerical value of the area vector and the preset rotation direction.

### Claim 4 (depends on 3)

The method of claim 3, wherein determining the position information about the rotation path of the positioning transmitting unit according to the numerical value of the area vector and the preset rotation direction comprises:
in response to the robot rotating clockwise, acquiring position coordinates of three non-collinear points on each rotation path according to a rotation sequence, determining an area vector formed by the three non-collinear points on each rotation path, and using a rotation path to which the three non-collinear points belong in a case where the area vector is negative as the position information about the rotation path of the positioning transmitting unit; or
in response to the robot rotating counterclockwise, acquiring position coordinates of three non-collinear points on each rotation path according to a rotation sequence, determining an area vector formed by the three non-collinear points on each rotation path, and using a rotation path to which the three non-collinear points belong in a case where the area vector is positive as the position information about the rotation path of the positioning transmitting unit.

### Claim 5 (depends on 1)

The method of claim 1, wherein determining the position information about the rotation path of the positioning transmitting unit according to the preset rotation direction and the set of at least three different position distances, comprises:
determining a change trend of each distance in the set of at least three different position distances between the positioning transmitting unit and the two positioning receiving units disposed at the different fixed positions; and
determining the position information about the rotation path of the positioning transmitting unit according to the change trend of each distance and the preset rotation direction.

### Claim 6 (depends on 5)

The method of claim 5, wherein determining the position information about the rotation path of the positioning transmitting unit according to the change trend of each distance and the preset rotation direction comprises:
in response to the robot rotating clockwise, and in a process in which a relative distance between the positioning transmitting unit and a first positioning receiving unit changes from a maximum value to a minimum value, a relative distance between the positioning transmitting unit and a second positioning receiving unit has a minimum value, the rotation path of the positioning transmitting unit is located on a right side of a direction extending from the second positioning receiving unit to the first positioning receiving unit; or
in response to the robot rotating clockwise, and in a process in which a relative distance between the positioning transmitting unit and a first positioning receiving unit changes from a maximum value to a minimum value, a relative distance between the positioning transmitting unit and a second positioning receiving unit has a maximum value, the rotation path of the positioning transmitting unit is located on a left side of a direction extending from the second positioning receiving unit to the first positioning receiving unit;
wherein the first positioning receiving unit is located on a left side of the second positioning receiving unit.

### Claim 7 (depends on 5)

The method of claim 5, wherein determining the position information about the rotation path of the positioning transmitting unit according to the change trend of each distance and the preset rotation direction comprises:
in response to the robot rotating counterclockwise, and in a process in which a relative distance between the positioning transmitting unit and a first positioning receiving unit changes from a maximum value to a minimum value, a relative distance between the positioning transmitting unit and a second positioning receiving unit has a maximum value, the rotation path of the positioning transmitting unit is located on a right side of a direction extending from the second positioning receiving unit to the first positioning receiving unit; or
in response to the robot rotating counterclockwise, and in a process in which a relative distance between the positioning transmitting unit and a first positioning receiving unit changes from a maximum value to a minimum value, a relative distance between the positioning transmitting unit and a second positioning receiving unit has a minimum value, the rotation path of the positioning transmitting unit is located on a left side of a direction extending from the second positioning receiving unit to the first positioning receiving unit;
wherein the first positioning receiving unit is located on a left side of the second positioning receiving unit.

### Claim 8

An electronic device, applied to a system for positioning a robot at start-up, comprising:
at least one processor, wherein the at least one processor serves as a controller in a system for positioning a robot at start-up, the system for positioning a robot at start-up comprises two positioning receiving units disposed at different fixed positions and a positioning transmitting unit disposed on the robot, and the positioning transmitting unit is in communication connection with the positioning receiving units and is configured to send positioning signals to the positioning receiving units; and
a storage apparatus, which is configured to store at least one program;
wherein the at least one program, when executed by the at least one processor, causes the at least one processor to implement the following steps:
when the robot is started up, controlling the robot to rotate in a preset rotation direction in a start-up positioning region;
determining position information about a rotation path of the positioning transmitting unit according to the preset rotation direction and a set of at least three different position distances, wherein the at least three different position distances are between the positioning transmitting unit and the two positioning receiving units and determined during a rotation process;
determining a center position of the rotation path according to the position information about the rotation path of the positioning transmitting unit;
using a direction extending from the center position of the rotation path to a position of the positioning transmitting unit when the robot stops rotation as orientation information of the robot; and
using the center position of the rotation path and the orientation information of the robot as start-up positioning information of the robot.

### Claim 9 (depends on 8)

The electronic device of claim 8, wherein distances between the start-up positioning region and the positioning receiving units are less than a preset distance threshold.

### Claim 10 (depends on 8)

The electronic device of claim 8, wherein the at least one program, when executed by the at least one processor, causes the at least one processor to implement determining the position information about the rotation path of the positioning transmitting unit by:
determining two mirror rotation paths of the positioning transmitting unit according to the set of the at least three different position distances;
acquiring position coordinates of three non-collinear points on each of the two mirror rotation paths according to a rotation sequence;
determining an area vector formed by the three non-collinear points on each of the two mirror rotation paths, and obtaining a calculated rotation direction of the robot according to a numerical value of the area vector; and
determining the position information about the rotation path of the positioning transmitting unit according to the numerical value of the area vector and the preset rotation direction.

### Claim 11 (depends on 10)

The electronic device of claim 10, wherein the at least one program, when executed by the at least one processor, causes the at least one processor to implement determining the position information about the rotation path of the positioning transmitting unit according to the numerical value of the area vector and the preset rotation direction by:
in response to the robot rotating clockwise, acquiring position coordinates of three non-collinear points on each rotation path according to a rotation sequence, determining an area vector formed by the three non-collinear points on each rotation path, and using a rotation path to which the three non-collinear points belong in a case where the area vector is negative as the position information about the rotation path of the positioning transmitting unit; or
in response to the robot rotating counterclockwise, acquiring position coordinates of three non-collinear points on each rotation path according to a rotation sequence, determining an area vector formed by the three non-collinear points on each rotation path, and using a rotation path to which the three non-collinear points belong in a case where the area vector is positive as the position information about the rotation path of the positioning transmitting unit.

### Claim 12 (depends on 8)

The electronic device of claim 8, wherein the at least one program, when executed by the at least one processor, causes the at least one processor to implement determining the position information about the rotation path of the positioning transmitting unit according to the preset rotation direction and the set of at least three different position distances by:
determining a change trend of each distance in the set of at least three different position distances between the positioning transmitting unit and the two positioning receiving units disposed at the different fixed positions; and
determining the position information about the rotation path of the positioning transmitting unit according to the change trend of each distance and the preset rotation direction.

### Claim 13 (depends on 12)

The electronic device of claim 12, wherein the at least one program, when executed by the at least one processor, causes the at least one processor to implement determining the position information about the rotation path of the positioning transmitting unit according to the change trend of each distance and the preset rotation direction by:
in response to the robot rotating clockwise, and in a process in which a relative distance between the positioning transmitting unit and a first positioning receiving unit changes from a maximum value to a minimum value, a relative distance between the positioning transmitting unit and a second positioning receiving unit has a minimum value, the rotation path of the positioning transmitting unit is located on a right side of a direction extending from the second positioning receiving unit to the first positioning receiving unit; or
in response to the robot rotating clockwise, and in a process in which a relative distance between the positioning transmitting unit and a first positioning receiving unit changes from a maximum value to a minimum value, a relative distance between the positioning transmitting unit and a second positioning receiving unit has a maximum value, the rotation path of the positioning transmitting unit is located on a left side of a direction extending from the second positioning receiving unit to the first positioning receiving unit;
wherein the first positioning receiving unit is located on a left side of the second positioning receiving unit.

### Claim 14 (depends on 12)

The electronic device of claim 12, wherein the at least one program, when executed by the at least one processor, causes the at least one processor to implement determining the position information about the rotation path of the positioning transmitting unit according to the change trend of each distance and the preset rotation direction by:
in response to the robot rotating counterclockwise, and in a process in which a relative distance between the positioning transmitting unit and a first positioning receiving unit changes from a maximum value to a minimum value, a relative distance between the positioning transmitting unit and a second positioning receiving unit has a maximum value, the rotation path of the positioning transmitting unit is located on a right side of a direction extending from the second positioning receiving unit to the first positioning receiving unit; or
in response to the robot rotating counterclockwise, and in a process in which a relative distance between the positioning transmitting unit and a first positioning receiving unit changes from a maximum value to a minimum value, a relative distance between the positioning transmitting unit and a second positioning receiving unit has a minimum value, the rotation path of the positioning transmitting unit is located on a left side of a direction extending from the second positioning receiving unit to the first positioning receiving unit;
wherein the first positioning receiving unit is located on a left side of the second positioning receiving unit.

### Claim 15

A non-transitory computer-readable storage medium, having a computer program stored thereon and applied to a system for positioning a robot at start-up, wherein the program is executable by a processer;
wherein the processor serves as a controller in a system for positioning a robot at start-up, the system for positioning a robot at start-up comprises two positioning receiving units disposed at different fixed positions and a positioning transmitting unit disposed on the robot, and the positioning transmitting unit is in communication connection with the positioning receiving units and is configured to send positioning signals to the positioning receiving units; and
wherein the program is configured to, when executed by the processor, cause the processor to perform the following steps:
when the robot is started up, controlling the robot to rotate in a preset rotation direction in a start-up positioning region;
determining position information about a rotation path of the positioning transmitting unit according to the preset rotation direction and a set of at least three different position distances, wherein the at least three different position distances are between the positioning transmitting unit and the two positioning receiving units and determined during a rotation process;
determining a center position of the rotation path according to the position information about the rotation path of the positioning transmitting unit;
using a direction extending from the center position of the rotation path to a position of the positioning transmitting unit when the robot stops rotation as orientation information of the robot; and
using the center position of the rotation path and the orientation information of the robot as start-up positioning information of the robot.

### Claim 16 (depends on 15)

The storage medium of claim 15, wherein distances between the start-up positioning region and the positioning receiving units are less than a preset distance threshold.

### Claim 17 (depends on 15)

The storage medium of claim 15, wherein the program is configured to, when executed by the processor, cause the processor to perform determining the position information about the rotation path of the positioning transmitting unit by:
determining two mirror rotation paths of the positioning transmitting unit according to the set of the at least three different position distances;
acquiring position coordinates of three non-collinear points on each of the two mirror rotation paths according to a rotation sequence;
determining an area vector formed by the three non-collinear points on each of the two mirror rotation paths, and obtaining a calculated rotation direction of the robot according to a numerical value of the area vector; and
determining the position information about the rotation path of the positioning transmitting unit according to the numerical value of the area vector and the preset rotation direction.

### Claim 18 (depends on 17)

The storage medium of claim 17, wherein the program is configured to, when executed by the processor, cause the processor to perform determining the position information about the rotation path of the positioning transmitting unit according to the numerical value of the area vector and the preset rotation direction by:
in response to the robot rotating clockwise, acquiring position coordinates of three non-collinear points on each rotation path according to a rotation sequence, determining an area vector formed by the three non-collinear points on each rotation path, and using a rotation path to which the three non-collinear points belong in a case where the area vector is negative as the position information about the rotation path of the positioning transmitting unit; or
in response to the robot rotating counterclockwise, acquiring position coordinates of three non-collinear points on each rotation path according to a rotation sequence, determining an area vector formed by the three non-collinear points on each rotation path, and using a rotation path to which the three non-collinear points belong in a case where the area vector is positive as the position information about the rotation path of the positioning transmitting unit.

### Claim 19 (depends on 15)

The storage medium of claim 15, wherein the program is configured to, when executed by the processor, cause the processor to perform determining the position information about the rotation path of the positioning transmitting unit according to the preset rotation direction and the set of at least three different position distances by:
determining a change trend of each distance in the set of at least three different position distances between the positioning transmitting unit and the two positioning receiving units disposed at the different fixed positions; and
determining the position information about the rotation path of the positioning transmitting unit according to the change trend of each distance and the preset rotation direction.

### Claim 20 (depends on 19)

The storage medium of claim 19, wherein the program is configured to, when executed by the processor, cause the processor to perform determining the position information about the rotation path of the positioning transmitting unit according to the change trend of each distance and the preset rotation direction by:
in response to the robot rotating clockwise, and in a process in which a relative distance between the positioning transmitting unit and a first positioning receiving unit changes from a maximum value to a minimum value, a relative distance between the positioning transmitting unit and a second positioning receiving unit has a minimum value, the rotation path of the positioning transmitting unit is located on a right side of a direction extending from the second positioning receiving unit to the first positioning receiving unit; or
in response to the robot rotating clockwise, and in a process in which a relative distance between the positioning transmitting unit and a first positioning receiving unit changes from a maximum value to a minimum value, a relative distance between the positioning transmitting unit and a second positioning receiving unit has a maximum value, the rotation path of the positioning transmitting unit is located on a left side of a direction extending from the second positioning receiving unit to the first positioning receiving unit;
wherein the first positioning receiving unit is located on a left side of the second positioning receiving unit.
