06.01.2015 Views

Where am I? Sensors and Methods for Mobile Robot Positioning

Where am I? Sensors and Methods for Mobile Robot Positioning

Where am I? Sensors and Methods for Mobile Robot Positioning

SHOW MORE
SHOW LESS

Create successful ePaper yourself

Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.

Chapter 2: Heading <strong>Sensors</strong> 53<br />

A system block diagr<strong>am</strong> is presented in Figure 2.21. The sensor consists of two orthogonal pickup<br />

coils arranged around a toroidal excitation coil, driven in turn by a local oscillator. The outputs V x<br />

<strong>and</strong> V y of <strong>am</strong>plifier channels A <strong>and</strong> B are applied across an air-core resolver to drive the display<br />

indicator. The st<strong>and</strong>ard resolver equations [ILC Corporation, 1982] <strong>for</strong> these two voltages are<br />

V = K sin sin(7t + a )<br />

x x x<br />

V = K cos sin(7t + a )<br />

y y y<br />

(2.12a)<br />

(2.12b)<br />

where<br />

= the resolver shaft angle<br />

7 = 2%f, where f is the excitation frequency.<br />

K <strong>and</strong> K are ideally equal transfer-function constants, <strong>and</strong> a <strong>and</strong> a are ideally zero time-phase<br />

x y x y<br />

shifts.<br />

Thus, <strong>for</strong> any static spatial angle , the equations reduce to<br />

V = K sin<br />

x<br />

x<br />

V = K cos<br />

y<br />

y<br />

(2.13a)<br />

(2.13b)<br />

which can be combined to yield<br />

V x<br />

V Y<br />

sin<br />

cos tan .<br />

(2.14)<br />

The magnetic heading <br />

there<strong>for</strong>e is simply the<br />

arctangent of V xover V y.<br />

Everett [1995] recounts<br />

his experience with two models<br />

of the Zemco fluxgate<br />

compass on ROBART II as<br />

follows:<br />

Problems associated with<br />

the use of this particular<br />

fluxgate compass on<br />

ROBART, however, included<br />

a fairly high current consumption<br />

(250 mA), <strong>and</strong><br />

stiction in the resolver reflecting<br />

back as a load into<br />

the drive circuitry, introducing<br />

some error <strong>for</strong> minor<br />

Fluxgate<br />

sensor<br />

Amplifier<br />

Driver<br />

Driver<br />

Oscillator<br />

Amplifier Driver<br />

Figure 2.21: Block diagr<strong>am</strong> of ZEMCO Model DE-700 fluxgate compass.<br />

(Courtesy of ZEMCO, Inc.)<br />

Air<br />

core<br />

resolver

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!