(12) United States Patent (10) Patent No.: US 9.205,828 B1 Lombroz0 Et Al
Total Page:16
File Type:pdf, Size:1020Kb
US009205828B1 (12) United States Patent (10) Patent No.: US 9.205,828 B1 LOmbroZ0 et al. (45) Date of Patent: Dec. 8, 2015 (54) METHOD AND APPARATUS FOR 2003/0050742 A1 3/2003 Sakamoto et al. ................ TO1/1 DETERMINING VEHICLE LOCATION 2003/0220731 A1* 11/2003 Zierolf ............................ 7O 1/71 2004/0163860 A1* 8, 2004 Matsuzaki et al. ........... 180,652 BASED ON MOTOR FEEDBACK 2005/02183.12 A1* 10/2005 Thannikary .............. 250,231.13 2007/0202991 A1* 8, 2007 Matsumura et al. .......... 477,174 (75) Inventors: Peter Craig Lombrozo, Santa Cruz, CA 2008.0078608 A1* 4, 2008 Hara et al. ......... ... 180,446 2008/O1890 12 A1* 8, 2008 Kaufmann ...................... TO1/41 (US); Carsten Jensen, San Francisco, 2008/0309267 A1* 12/2008 Cheng ............ ... 318, 400.04 CA (US); Andrew Barton-Sweeney, 2010, 0123426 A1* 5, 2010 Nashiki et al. ................ 318,701 Berkeley, CA (US); Russell Smith, 2010/0168940 A1* 7/2010 King ............................... TO1/20 Santa Clara, CA (US); Daniel Lynn 2010/0274607 A1* 10/2010 Carresjo et al. 705/7 2011/0295457 A1* 12/2011 Linda et al. ........ 701/29 Larner, San Jose, CA (US) 2012/0109416 A1* 5, 2012 Mizutani et al. ... ... 701 1 2012/01851 22 A1* 7, 2012 Sullivan et al. .... 701.23 (73) Assignee: Google Inc., Mountain View, CA (US) 2012fO245765 A1 9, 2012 Medwin et al. ................... 7O1/2 2012/0265439 A1 * 10/2012 Radner ......................... 701 468 (*) Notice: Subject to any disclaimer, the term of this 2013/0134967 A1* 5, 2013 Kaufmann et al. ...... 324,207.25 patent is extended or adjusted under 35 U.S.C. 154(b) by 10 days. OTHER PUBLICATIONS iPedia net: Free Information Center, “What is Derivatives of Dis (21) Appl. No.: 13/539,030 placement?”, downloaded on Sep. 10, 2014 from <http://wearcam. org/absement/Derivatives of displacement.htm>. (22) Filed: Jun. 29, 2012 * cited by examiner (51) Int. Cl. B60/20/00 (2006.01) Primary Examiner — Helal A Algahaim B60/30/00 (2006.01) Assistant Examiner — Jelani Smith (52) U.S. Cl. (74) Attorney, Agent, or Firm — Lerner, David, Littenberg, CPC ............... B60W 20/00 (2013.01); B60W 30/00 Krumholz & Mentlik, LLP (2013.01) (58) Field of Classification Search (57) ABSTRACT CPC ..... B60W 20/00; B60W 10/08: B60W 10/06; A method and apparatus are provided for determining the Y02T 10/6286; B60K 6/445 location of a vehicle. According to one aspect the method and USPC ......... 701/1, 2, 22, 23, 25, 408, 41, 468, 470, apparatus the movements of motor rotors in a vehicle are 701/472, 50, 51; 290/40 C; 180/204; 705/39 monitored and used to determine speed, travel distance and/or See application file for complete search history. travel path of a vehicle may be determined. Using various navigation techniques, the distance and travel path may then (56) References Cited be used to determine the vehicle's location. Furthermore, movements of the motor rotors may also be used to report the U.S. PATENT DOCUMENTS positions of the steering and drive systems for the purpose of 5,341,130 A * 8/1994 Yardley et al. ................. 340/3.1 informing the vehicle controller as a method offeedback. 7,383,902 B2 * 6/2008 Matsuzaki et al. 18O, 65.285 8,041.535 B1 * 10/2011 Kelly et al. ................... 7O2/151 20 Claims, 20 Drawing Sheets FRON REAR U.S. Patent Dec. 8, 2015 Sheet 1 of 20 US 9.205,828 B1 U.S. Patent Dec. 8, 2015 Sheet 2 of 20 US 9.205,828 B1 Vehicle 101 Power Train 22O Steering System 230 Vehicle Control Unit Acceleration System 240 Braking System 250 210 Fig. 2 U.S. Patent Dec. 8, 2015 Sheet 3 of 20 US 9.205,828 B1 340a w w Device(s)ansfer ) U.S. Patent Dec. 8, 2015 Sheet 5 of 20 US 9.205,828 B1 s s U.S. Patent Dec. 8, 2015 Sheet 6 of 20 US 9.205,828 B1 teerina System 230 Fig. 4A U.S. Patent US 9.205,828 B1 U.S. Patent Dec. 8, 2015 Sheet 8 of 20 US 9.205,828 B1 s U.S. Patent Dec. 8, 2015 Sheet 9 of 20 US 9.205,828 B1 Vehicle Front 340a &8 8x 340b DVehicle Right Vehicle Rear Fig. 4E 340a 340b U.S. Patent Dec. 8, 2015 Sheet 10 of 20 US 9.205,828 B1 210 Vehicle Control Unit 510 Processor 520 530 540 Fig. 5 U.S. Patent Dec. 8, 2015 Sheet 11 of 20 US 9.205,828 B1 610 Determine a First Location Li of a Vehicle at Time T. Receive Signal Feedback That is indicative of 620 a Displacement of a Rotor of a Motor that is Part of the Vehicle's Power Train Determine, Based At Least in Part on the 630 Signal Feedback, a Second Location L2 of the Vehicle at Time T2 Control the Operation of the Vehicle Based on 640 the Determined Location U.S. Patent Dec. 8, 2015 Sheet 12 of 20 US 9.205,828 B1 From Task 610 700 rooroooooooooooooooo-o-o-o-o-o-o-o-o-o-o-o-o-o-o-o-o-o-ooroooooooooooooooooooooooooooooooooooooooo Task. 630. Determine. Based At Least in Part on the Signal Feedback, a Second Location L2 of the Vehicle at Time T2 710 Determine a Velocity of the Rotor 320-1 Based on the Received Signal 720 Adjust the Determined Velocity to Produce an Adjusted Rotor Velocity 730 Determine the Velocity of One or More Wheels of the Vehicle Based on the Adjusted Rotor Velocity 740 Determine a Location L2 of the Vehicle 101 Based on the Velocity of One or More of the Wheels of the Vehicle To Task 630 F ig 7 U.S. Patent Dec. 8, 2015 Sheet 13 of 20 US 9.205,828 B1 From Task 710 800 Compensate for a Disengagement of the Motor 320 from the Wheels of the Vehicle To Task 730 Fig. 8 U.S. Patent Dec. 8, 2015 Sheet 14 of 20 US 9.205,828 B1 900 Determine the Orientation of a Rotor Multiple 910 Times in A Single Rotation, The Rotor Belonging to a Motor that is Part of a Vehicle's Power Train Determine at Least One of Angular 920 Displacement of the Rotor Around its Access of Rotation or the N-th Derivative of the Angular Displacement Determine at Least One of Linear Displacement 930 of the Vehicle or the N-th Derivative of the Linear Displacement of the Vehicle Use the Determined Displacement of the 940 Vehicle or the N-th Derivative of the Displacement to Control the Operation of the Vehicle End U.S. Patent Dec. 8, 2015 Sheet 15 of 20 US 9.205,828 B1 O0|'fil 096XSeLuJOJ GOL'6|+ do01Ionuo.O VOI'6|- U.S. Patent Dec. 8, 2015 Sheet 16 of 20 US 9.205,828 B1 1100 1110 Determine a First Location L1 of a Vehicle at Time T, Receive Signal Feedback That is indicative of 1120 a Displacement of a Rotor of a Motor that is Part of the Vehicle's Steering System Determine, Based At Least in Part on the 1130 Signal, a Second Location L2 of the Vehicle at Time T2 Control the Operation of the Vehicle Based on 1140 the Determined Location& U.S. Patent Dec. 8, 2015 Sheet 17 of 20 US 9.205,828 B1 From Task 1120 1200 Task: 1130. Determine. Based At Least in Part on the Signal, a Second Location L2 of the Vehicle at Time I2 1210 Compensate For An Axial Misalignment Between the Rotor 440a and the Resolver 450 1220 Determine a Displacement of the Rotor 440-1 Based on the Received Signal 1230 Determine an indication of Steering Direction Which One or More Wheels of the Vehicle are Pointed To 1240 Determine a Location L2 of the Vehicle 101 Based on the Determined indication of Steering Direction To Task 1140 Fig. 12 U.S. Patent Dec. 8, 2015 Sheet 18 of 20 US 9.205,828 B1 N -61-17uo?eooT 9| U.S. Patent Dec. 8, 2015 Sheet 19 of 20 US 9.205,828 B1 1400 Determine the Orientation of a Rotor Multiple 1410 Times in A Single Rotation, The Rotor Belonging to a Motor that is Part of a Vehicle's Steering System Determine at Least One of Angular 1420 Displacement of the Rotor Around its Access of Rotation or the N-th Derivative of the Angular Displacement Determine at Least One of Angular 1430 Displacement of Wheels of the Vehicle or the N-th Derivative of the Angular Displacement of the Vehicle's Wheels Use the Determined Displacement of the 1440 Vehicle Wheels or the N-th Derivative of the Displacement of the Vehicle Wheels to Control the Operation of the Vehicle End Fig. 14 US 9,205,828 B1 1. 2 METHOD AND APPARATUS FOR rotor may further be determined based on a speed ratio of the DETERMINING VEHICLE LOCATION coupling between the first rotor and the second rotor. The BASED ON MOTOR FEEDBACK vehicle may further include a clutch and the processor may be configured to detect whether the clutch is engaged or disen BACKGROUND gaged. The at least one of the braking system, the steering system, and the acceleration system may further be operated Autonomous vehicles use artificial intelligence to aid in the based on the determined displacement of the rotor or the transport of passengers. When travelling from one location to derivative of the displacement of the rotor only when it is another, autonomous vehicles may use inertial navigation determined that the clutch is engaged.