Doorway transit navigational referencing system

• US 5,276,618 A
• Filed: 02/26/1992
• Issued: 01/04/1994
• Est. Priority Date: 02/26/1992
• Status: Expired due to Fees

• Current Assignee: the united states of america as represented by the secretary of the navy
• Original Assignee: the united states of america as represented by the secretary of the navy
• Inventors: Everett, Hobart R. Jr.
• Primary Examiner(s): Black, Thomas G.
• Assistant Examiner(s): NGUYEN, TAN QUANG
• Application Number:
  US07/846,486
• Time in Patent Office: 678 Days
• Field of Search: 364/424.02, 364/449, 364/447, 364/424.07, 364/516, 364/517, 364/429, 340/988, 250/202
• US Class Current: 701/25
• CPC Class Codes: G05D 1/0246 using a video camera in combination with image processing means
• CPC Class Codes: G05D 1/0255 using acoustic signals, e.g. ultra-sonic singals sonar systems designed for anti-collision purposes G01S15/93
• CPC Class Codes: G05D 1/0272 comprising means for registering the travel distance, e.g. revolutions of wheels measuring distance traversed on the ground by vehicles, e.g. using odometers G01C22/00

Abstract

A system of navigational referencing for a robot moving within a defined space is provided. A database contains x-y coordinate positional information on a plurality of doorway openings in terms of an x-y coordinate system. A mobile robot is provided that has the capability to access the database, define its location in terms of an approximate position within the defined space, and sense the presence of one of the plurality of doorway openings. The robot is positioned and moved along a path that traverses the one doorway opening at a known speed. The doorway opening'"'"'s top door frame is detected from first and second sensor positions on the robot. The first and second sensor positions are separated by a known distance along a line orthogonal to the path that traverses the one doorway opening. An angular orientation of the robot is based on a time difference between when the first and second sensor positions detect the top door frame, the known speed of the robot and the known separation distance between the first and second sensor positions. A y-coordinate position of the robot is based on the positional information from the database when the first or second sensing position detects the top door frame. A lateral position of the robot is determined during a portion of the time between when the first and second sensor positions detect the top door frame. The lateral position is compared with the positional information from the database in order to determine an x-coordinate of the robot.

Claims

1. A method of navigational referencing for a robot which moves within a defined space comprising the steps of:

providing the robot with positional information on the defined space in terms of plurality of doorway openings, each doorway opening having left, right and top door frames defining first and second imaginary vertical planes at the beginning and ending, respectively, of each doorway opening, the first and second imaginary vertical planes further being orthogonal to the floor of the defined space, wherein the first and second imaginary vertical planes for each of the plurality of doorway openings are defined in terms of an x-y coordinate system;

finding one of the plurality of doorway openings;

positioning the robot on a heading to traverse said one doorway opening;

moving the robot along a path defined by the heading in order to traverse said one doorway opening at a known speed;

detecting the top door frame from a first sensor position on the robot when the first sensor position enters the first imaginary vertical plane;

detecting the top door frame from a second sensor position on the robot when the second sensor position enters the first imaginary vertical plane, wherein the first and second sensor positions are separated by a known distance along a line orthogonal to the path defined by the robot'"'"'s heading;

measuring a time difference between when the first and second sensor positions break the first imaginary vertical plane, wherein an angular orientation α

of the robot within the x-y coordinate system is based on the measured time difference, the known speed of the robot and the known separation distance between the first and second sensor positions, and a y-coordinate position of the robot within the x-y coordinate system is based on the provided positional information on the first imaginary vertical plane when the first or second sensing position enters said first imaginary vertical plane; and

determining a lateral position of the robot with respect to said one doorway opening during a portion of the time between the first sensor position entering the first imaginary vertical plane and the second sensor position entering the second imaginary vertical plane, wherein the lateral position is compared with the provided positional information of said one doorway opening in order to determine an x-coordinate of the robot within the x-y coordinate system.

2. A method according to claim 1 wherein the angular orientation α

of the robot within the x-y coordinate system is equal to ##EQU2## where V is the known speed of the robot,

T is the measured time difference between when the first and second sensor positions break the first imaginary vertical plane, and

d is the known separation distance between the first and second sensor positions.

3. A method according to claim 1 wherein said step of determining the lateral position of the robot includes the step of measuring a distance to the left and right door frames during the portion of the time between the first sensor position entering the first imaginary vertical plane and the second sensor position entering second imaginary vertical plane.

4. A method according to claim 3 wherein the distance to the left and right door frames is determined by acoustic time-of-flight techniques.

5. A system of navigational referencing within a defined space comprising:

a database containing positional information on the defined space in terms of a plurality of doorway openings, each doorway opening having left, right and top door frames defining first and second imaginary vertical planes at the beginning and ending, respectively, of each doorway opening, the first and second imaginary vertical planes further being orthogonal to the floor of the defined space, wherein the first and second imaginary vertical planes for each of the plurality of doorway openings are defined in terms of an x-y coordinate system;

a mobile robot having the capability to access said database, define its location in terms of an approximate position within said x-y coordinate system, and sense the presence of one of said plurality of doorway openings;

means for positioning and moving the robot along a path that traverses said one doorway opening at a known speed;

means for detecting the top door frame from a first and second sensor position on the robot when the first and second sensor positions break the first imaginary vertical plane, wherein the first and second sensor positions are separated by a known distance along a line orthogonal to the path that traverses the one doorway opening, wherein an angular orientation α

of the robot within the x-y coordinate system is based on a time difference between when the first and second sensor positions break the first imaginary vertical plane, the known speed of the robot and the known separation distance between the first and second sensor positions, and a y-coordinate position of the robot within the x-y coordinate system is based on the positional information available from said database on the first imaginary vertical plane when the first or second sensing position enters said first imaginary vertical plane; and

means for determining a lateral position of the robot with respect to the one doorway opening during a portion of the time between the first sensor position entering the first imaginary vertical plane and the second sensor position entering the second imaginary vertical plane, wherein the lateral position is compared with the positional information from said database on said one doorway opening in order to determine an x-coordinate of the robot within the x-y coordinate system.

6. A system as in claim 5 wherein the angular orientation α

of the robot within the x-y coordinate system is equal to ##EQU3## where V is the known speed of the robot,

T is the time difference between when the first and second sensor positions break the first imaginary vertical plane, and

d is the known separation distance between the first and second sensor positions.

7. A system as in claim 5 wherein said means for detecting the top door frame comprises first and second proximity sensors at said first and second sensor positions, respectively.

8. A system as in claim 7 wherein each of said proximity sensors comprises a proximity sensor pair, each sensor pair including an emitter having an emitter beam and a detector having a detecting beam, wherein said emitter beam and detection beam are focused to intersect in a zone, whereby the top door frame of the one door opening passes through the zone as the robot traverses the one doorway opening.

9. A system as in claim 8 wherein said emitter and said detector operate in a convergent-mode in a near-infrared region.

10. A system as in claim 5 wherein said means for determining the lateral position of the robot comprises means for measuring a distance from the robot to the left and right door frames, respectively.

11. A system as in claim 10 wherein said means for measuring a distance comprises acoustic range finders activated when the first sensor position enters the first imaginary vertical plane and deactivated when the second sensor position enters the second imaginary vertical plane.