×

Indoor mobile robot position and posture measurement system based on photoelectric scanning and measurement method

  • US 10,801,843 B2
  • Filed: 05/27/2016
  • Issued: 10/13/2020
  • Est. Priority Date: 07/31/2015
  • Status: Active Grant
0
Associated Cases
0
Associated Defendants
0
Product Citations
0
Petitions
0
Forward Citations
1
Assignment
First Claim
Patent Images

1. An indoor mobile robot position and posture measurement system based on photoelectric scanning, including a mobile robot (1) which is arranged with a laser transmitter (2), a peripheral of the laser transmitter (2) provided with at least three receivers (3) for receiving light signals emitted by the laser transmitter (2), and at least one signal processor (4) connected to the at least three receivers (3) for processing signals received by the at least three receivers (3) to determine precise coordinates of the at least three receivers in a laser transmitter coordinate system, and a terminal computer (5) wirelessly connected with the at least one signal processor (4) to determine a posture angle and a position of the mobile robot by determining distances between the laser transmitter and each receiver, wherein the measurement method comprises the following steps:

  • Step 1;

    establishing &

    global navigation coordinate system, and measuring 3D coordinates of each receiver in the global navigation coordinate system by a laser tracker or an indoor GPS;

    Step 2;

    receiving, by each receiver, a scanning laser signal emitted by an infrared laser of the laser transmitter and a synchronous pulse laser signal emitted by a synchronous pulse laser, and sending the scanning laser signal and the synchronous pulse laser signal to the at least one signal processor;

    calculating, by the at least one signal processor, the precise coordinates of each receiver in a laser transmitter coordinate system, including two scanning angles θ

    i1, θ

    i2, a horizontal angle α

    i and a vertical angle β

    i of each receiver i corresponding to the laser transmitter coordinate system, and storing the precise coordinates into the terminal computer;

    Step 3;

    calculating, by the terminal computer, the distances between the laser transmitter and each receiver according to the precise coordinates of each receiver, respectively;

    Step 4;

    expressing approximate coordinates of each receiver in the laser transmitter coordinate system as ρ

    i=di (cos β

    i, cos α

    i, cos β

    i, sin α

    i, sin β

    i) taking the approximate coordinates as initial values, and performing an iteration calculation to update the precise coordinates of each receiver in the laser transmitter coordinate system;

    Step 5;

    performing coordinates conversion according to the precise coordinates achieved by step 4 and the 3D coordinates of the at least three receivers achieved by step 1 to obtain a posture matrix and a translation matrix of the laser transmitter coordinate system corresponding to the global navigation coordinate system;

    Step 6;

    acquiring the posture angle of the mobile robot according to the posture matrix and acquiring the position of the mobile robot according to the translation matrix.

View all claims
  • 1 Assignment
Timeline View
Assignment View
    ×
    ×