WebSVN - FlightCtrl - Diff - Rev 2049 and 2051 - /branches/dongfang_FC


#ifndef _ANALOG_H
#define _ANALOG_H
#include <inttypes.h>
#include "configuration.h"
 
/*
 About setting constants for different gyros:
 Main parameters are positive directions and voltage/angular speed gain.
 The "Positive direction" is the rotation direction around an axis where
 the corresponding gyro outputs a voltage > the no-rotation voltage.
 A gyro is considered, in this code, to be "forward" if its positive
 direction is:
 - Nose down for pitch
 - Left hand side down for roll
 - Clockwise seen from above for yaw.
 
 Setting gyro gain correctly: All sensor measurements in analog.c take
 place in a cycle, each cycle comprising all sensors. Some sensors are
 sampled more than once (oversampled), and the results added.
 In the H&I code, the results for pitch and roll are multiplied by 2 (FC1.0)
 or 4 (other versions), offset to zero, low pass filtered and then assigned
 to the "HiResXXXX" and "AdWertXXXXFilter" variables, where XXXX is nick or
 roll. The factor 2 or 4 or whatever is called GYRO_FACTOR_PITCHROLL here.
*/
#define GYRO_FACTOR_PITCHROLL 1
 
/*
 GYRO_HW_FACTOR is the relation between rotation rate and ADCValue:
 ADCValue [units] =
 rotational speed [deg/s] *
 gyro sensitivity [V / deg/s] *
 amplifier gain [units] *
 1024 [units] /
 3V full range [V]
 
 GYRO_HW_FACTOR is:
 gyro sensitivity [V / deg/s] *
 amplifier gain [units] *
 1024 [units] /
 3V full range [V]
 
 Examples:
 FC1.3 has 0.67 mV/deg/s gyros and amplifiers with a gain of 5.7:
 GYRO_HW_FACTOR = 0.00067 V / deg / s * 5.7 * 1024 / 3V = 1.304 units/(deg/s).
 
 FC2.0 has 6*(3/5) mV/deg/s gyros (they are ratiometric) and no amplifiers:
 GYRO_HW_FACTOR = 0.006 V / deg / s * 1 * 1024 * 3V / (3V * 5V) = 1.2288 units/(deg/s).
 
 My InvenSense copter has 2mV/deg/s gyros and no amplifiers:
 GYRO_HW_FACTOR = 0.002 V / deg / s * 1 * 1024 / 3V = 0.6827 units/(deg/s)
 (only about half as sensitive as V1.3. But it will take about twice the
 rotation rate!)
 
 GYRO_HW_FACTOR is given in the makefile.
*/
 
/*
 * How many samples are added in one ADC loop, for pitch&roll and yaw,
 * respectively. This is = the number of occurences of each channel in the
 * channelsForStates array in analog.c.
 */
#define GYRO_OVERSAMPLING_PITCHROLL 4
#define GYRO_OVERSAMPLING_YAW 2
 
#define ACC_OVERSAMPLING_XY 2
#define ACC_OVERSAMPLING_Z 1
 
/*
 * The product of the 3 above constants. This represents the expected change in ADC value sums for 1 deg/s of rotation rate.
 */
#define GYRO_RATE_FACTOR_PITCHROLL (GYRO_HW_FACTOR * GYRO_OVERSAMPLING_PITCHROLL * GYRO_FACTOR_PITCHROLL)
#define GYRO_RATE_FACTOR_YAW (GYRO_HW_FACTOR * GYRO_OVERSAMPLING_YAW)
 
/*
 * The value of gyro[PITCH/ROLL] for one deg/s = The hardware factor H * the number of samples * multiplier factor.
 * Will be about 10 or so for InvenSense, and about 33 for ADXRS610.
 */
 
/*
 * Gyro saturation prevention.
 */
// How far from the end of its range a gyro is considered near-saturated.
#define SENSOR_MIN_PITCHROLL 32
// Other end of the range (calculated)
#define SENSOR_MAX_PITCHROLL (GYRO_OVERSAMPLING_PITCHROLL * 1023 - SENSOR_MIN_PITCHROLL)
// Max. boost to add "virtually" to gyro signal at total saturation.
#define EXTRAPOLATION_LIMIT 2500
// Slope of the boost (calculated)
#define EXTRAPOLATION_SLOPE (EXTRAPOLATION_LIMIT/SENSOR_MIN_PITCHROLL)
 
/*
 * This value is subtracted from the gyro noise measurement in each iteration,
 * making it return towards zero.
 */
#define GYRO_NOISE_MEASUREMENT_DAMPING 5
 
#define PITCH 0
#define ROLL 1
#define YAW 2
#define Z 2
/*
 * The values that this module outputs
 * These first 2 exported arrays are zero-offset. The "PID" ones are used
 * in the attitude control as rotation rates. The "ATT" ones are for
 * integration to angles. For the same axis, the PID and ATT variables
 * generally have about the same values. There are just some differences
 * in filtering, and when a gyro becomes near saturated.
 * Maybe this distinction is not really necessary.
 */
extern int16_t gyro_PID[2];
extern int16_t gyro_ATT[2];
extern int16_t gyroD[2];
extern int16_t yawGyro;
extern volatile uint16_t ADCycleCount;
extern int16_t UBat;
 
// 1:11 voltage divider, 1024 counts per 3V, and result is divided by 3.
#define UBAT_AT_5V (int16_t)((5.0 * (1.0/11.0)) * 1024 / (3.0 * 3))
 
extern sensorOffset_t gyroOffset;
extern sensorOffset_t accOffset;
extern sensorOffset_t gyroAmplifierOffset;
 
/*
 * This is not really for external use - but the ENC-03 gyro modules needs it.
 */
//extern volatile int16_t rawGyroSum[3];
 
/*
 * The acceleration values that this module outputs. They are zero based.
 */
extern int16_t acc[3];
extern int16_t filteredAcc[3];
// extern volatile int32_t stronglyFilteredAcc[3];
 
/*
 * Diagnostics: Gyro noise level because of motor vibrations. The variables
 * only really reflect the noise level when the copter stands still but with
 * its motors running.
 */
extern uint16_t gyroNoisePeak[3];
extern uint16_t accNoisePeak[3];
 
/*
 * Air pressure.
 * The sensor has a sensitivity of 45 mV/kPa.
 * An approximate p(h) formula is = p(h[m])[kPa] = p_0 - 11.95 * 10^-3 * h
 * p(h[m])[kPa] = 101.3 - 11.95 * 10^-3 * h
 * 11.95 * 10^-3 * h = 101.3 - p[kPa]
 * h = (101.3 - p[kPa])/0.01195
 * That is: dV = -45 mV * 11.95 * 10^-3 dh = -0.53775 mV / m.
 * That is, with 38.02 * 1.024 / 3 steps per mV: -7 steps / m
 
Display pressures
4165 mV-->1084.7
4090 mV-->1602.4   517.7
3877 mV-->3107.8  1503.4
 
4165 mV-->1419.1
3503 mV-->208.1
Diff.:   1211.0
 
Calculated  Vout = 5V(.009P-0.095) --> 5V .009P = Vout + 5V 0.095 --> P = (Vout + 5V 0.095)/(5V 0.009)
4165 mV = 5V(0.009P-0.095)  P = 103.11 kPa  h = -151.4m
4090 mV = 5V(0.009P-0.095)  P = 101.44 kPa  h = -11.7m   139.7m
3877 mV = 5V(0.009P-0.095)  P = 96.7   kPa  h = 385m     396.7m
 
4165 mV = 5V(0.009P-0.095)  P = 103.11 kPa  h = -151.4m
3503 mV = 5V(0.009P-0.095)  P = 88.4   kPa  h = 384m  Diff: 1079.5m
Pressure at sea level: 101.3 kPa. voltage: 5V * (0.009P-0.095) = 4.0835V
This is OCR2 = 143.15 at 1.5V in --> simple pressure =
*/
 
#define AIRPRESSURE_OVERSAMPLING 14
#define AIRPRESSURE_FILTER 8
// Minimum A/D value before a range change is performed.
#define MIN_RAWPRESSURE (200 * 2)
// Maximum A/D value before a range change is performed.
#define MAX_RAWPRESSURE (1023 * 2 - MIN_RAWPRESSURE)
 
#define MIN_RANGES_EXTRAPOLATION 15
#define MAX_RANGES_EXTRAPOLATION 240
 
#define PRESSURE_EXTRAPOLATION_COEFF 25L
#define AUTORANGE_WAIT_FACTOR 1
 
#define ABS_ALTITUDE_OFFSET 108205
 
extern uint16_t simpleAirPressure;
/*
 * At saturation, the filteredAirPressure may actually be (simulated) negative.
 */
extern int32_t filteredAirPressure;
 
extern int16_t magneticHeading;
 
/*
 * Flag: Interrupt handler has done all A/D conversion and processing.
 */
extern volatile uint8_t analogDataReady;
 
 
void analog_init(void);
 
/*
 * This is really only for use for the ENC-03 code module, which needs to get the raw value
 * for its calibration. The raw value should not be used for anything else.
 */
uint16_t rawGyroValue(uint8_t axis);
 
/*
 * Start the conversion cycle. It will stop automatically.
 */
void startAnalogConversionCycle(void);
 
/*
 * Process the sensor data to update the exported variables. Must be called after each measurement cycle and before the data is used.
 */
void analog_update(void);
 
/*
 * Read gyro and acc.meter calibration from EEPROM.
 */
void analog_setNeutral(void);
 
/*
 * Zero-offset gyros and write the calibration data to EEPROM.
 */
void analog_calibrateGyros(void);
 
/*
 * Zero-offset accelerometers and write the calibration data to EEPROM.
 */
void analog_calibrateAcc(void);
 
 
void analog_setGround(void);
 
int32_t analog_getHeight(void);
int16_t analog_getDHeight(void);
 
#endif //_ANALOG_H
 

Subversion Repositories FlightCtrl

(root)/branches/dongfang_FC_rewrite/analog.h - Rev 2049 → 2051

Rev 2049		Rev 2051
1	#ifndef _ANALOG_H	1	#ifndef _ANALOG_H
2	#define _ANALOG_H	2	#define _ANALOG_H
3	#include <inttypes.h>	3	#include <inttypes.h>
4	#include "configuration.h"	4	#include "configuration.h"
5		5
6	/*	6	/*
7	About setting constants for different gyros:	7	About setting constants for different gyros:
8	Main parameters are positive directions and voltage/angular speed gain.	8	Main parameters are positive directions and voltage/angular speed gain.
9	The "Positive direction" is the rotation direction around an axis where	9	The "Positive direction" is the rotation direction around an axis where
10	the corresponding gyro outputs a voltage > the no-rotation voltage.	10	the corresponding gyro outputs a voltage > the no-rotation voltage.
11	A gyro is considered, in this code, to be "forward" if its positive	11	A gyro is considered, in this code, to be "forward" if its positive
12	direction is:	12	direction is:
13	- Nose down for pitch	13	- Nose down for pitch
14	- Left hand side down for roll	14	- Left hand side down for roll
15	- Clockwise seen from above for yaw.	15	- Clockwise seen from above for yaw.
16		16
17	Setting gyro gain correctly: All sensor measurements in analog.c take	17	Setting gyro gain correctly: All sensor measurements in analog.c take
18	place in a cycle, each cycle comprising all sensors. Some sensors are	18	place in a cycle, each cycle comprising all sensors. Some sensors are
19	sampled more than once (oversampled), and the results added.	19	sampled more than once (oversampled), and the results added.
20	In the H&I code, the results for pitch and roll are multiplied by 2 (FC1.0)	20	In the H&I code, the results for pitch and roll are multiplied by 2 (FC1.0)
21	or 4 (other versions), offset to zero, low pass filtered and then assigned	21	or 4 (other versions), offset to zero, low pass filtered and then assigned
22	to the "HiResXXXX" and "AdWertXXXXFilter" variables, where XXXX is nick or	22	to the "HiResXXXX" and "AdWertXXXXFilter" variables, where XXXX is nick or
23	roll. The factor 2 or 4 or whatever is called GYRO_FACTOR_PITCHROLL here.	23	roll. The factor 2 or 4 or whatever is called GYRO_FACTOR_PITCHROLL here.
24	*/	24	*/
25	#define GYRO_FACTOR_PITCHROLL 1	25	#define GYRO_FACTOR_PITCHROLL 1
26		26
27	/*	27	/*
28	GYRO_HW_FACTOR is the relation between rotation rate and ADCValue:	28	GYRO_HW_FACTOR is the relation between rotation rate and ADCValue:
29	ADCValue [units] =	29	ADCValue [units] =
30	rotational speed [deg/s] *	30	rotational speed [deg/s] *
31	gyro sensitivity [V / deg/s] *	31	gyro sensitivity [V / deg/s] *
32	amplifier gain [units] *	32	amplifier gain [units] *
33	1024 [units] /	33	1024 [units] /
34	3V full range [V]	34	3V full range [V]
35		35
36	GYRO_HW_FACTOR is:	36	GYRO_HW_FACTOR is:
37	gyro sensitivity [V / deg/s] *	37	gyro sensitivity [V / deg/s] *
38	amplifier gain [units] *	38	amplifier gain [units] *
39	1024 [units] /	39	1024 [units] /
40	3V full range [V]	40	3V full range [V]
41		41
42	Examples:	42	Examples:
43	FC1.3 has 0.67 mV/deg/s gyros and amplifiers with a gain of 5.7:	43	FC1.3 has 0.67 mV/deg/s gyros and amplifiers with a gain of 5.7:
44	GYRO_HW_FACTOR = 0.00067 V / deg / s * 5.7 * 1024 / 3V = 1.304 units/(deg/s).	44	GYRO_HW_FACTOR = 0.00067 V / deg / s * 5.7 * 1024 / 3V = 1.304 units/(deg/s).
45		45
46	FC2.0 has 6*(3/5) mV/deg/s gyros (they are ratiometric) and no amplifiers:	46	FC2.0 has 6*(3/5) mV/deg/s gyros (they are ratiometric) and no amplifiers:
47	GYRO_HW_FACTOR = 0.006 V / deg / s * 1 * 1024 * 3V / (3V * 5V) = 1.2288 units/(deg/s).	47	GYRO_HW_FACTOR = 0.006 V / deg / s * 1 * 1024 * 3V / (3V * 5V) = 1.2288 units/(deg/s).
48		48
49	My InvenSense copter has 2mV/deg/s gyros and no amplifiers:	49	My InvenSense copter has 2mV/deg/s gyros and no amplifiers:
50	GYRO_HW_FACTOR = 0.002 V / deg / s * 1 * 1024 / 3V = 0.6827 units/(deg/s)	50	GYRO_HW_FACTOR = 0.002 V / deg / s * 1 * 1024 / 3V = 0.6827 units/(deg/s)
51	(only about half as sensitive as V1.3. But it will take about twice the	51	(only about half as sensitive as V1.3. But it will take about twice the
52	rotation rate!)	52	rotation rate!)
53		53
54	GYRO_HW_FACTOR is given in the makefile.	54	GYRO_HW_FACTOR is given in the makefile.
55	*/	55	*/
56		56
57	/*	57	/*
58	* How many samples are added in one ADC loop, for pitch&roll and yaw,	58	* How many samples are added in one ADC loop, for pitch&roll and yaw,
59	* respectively. This is = the number of occurences of each channel in the	59	* respectively. This is = the number of occurences of each channel in the
60	* channelsForStates array in analog.c.	60	* channelsForStates array in analog.c.
61	*/	61	*/
62	#define GYRO_OVERSAMPLING_PITCHROLL 4	62	#define GYRO_OVERSAMPLING_PITCHROLL 4
63	#define GYRO_OVERSAMPLING_YAW 2	63	#define GYRO_OVERSAMPLING_YAW 2
64		64
65	#define ACC_OVERSAMPLING_XY 2	65	#define ACC_OVERSAMPLING_XY 2
66	#define ACC_OVERSAMPLING_Z 1	66	#define ACC_OVERSAMPLING_Z 1
67		67
68	/*	68	/*
69	* The product of the 3 above constants. This represents the expected change in ADC value sums for 1 deg/s of rotation rate.	69	* The product of the 3 above constants. This represents the expected change in ADC value sums for 1 deg/s of rotation rate.
70	*/	70	*/
71	#define GYRO_RATE_FACTOR_PITCHROLL (GYRO_HW_FACTOR * GYRO_OVERSAMPLING_PITCHROLL * GYRO_FACTOR_PITCHROLL)	71	#define GYRO_RATE_FACTOR_PITCHROLL (GYRO_HW_FACTOR * GYRO_OVERSAMPLING_PITCHROLL * GYRO_FACTOR_PITCHROLL)
72	#define GYRO_RATE_FACTOR_YAW (GYRO_HW_FACTOR * GYRO_OVERSAMPLING_YAW)	72	#define GYRO_RATE_FACTOR_YAW (GYRO_HW_FACTOR * GYRO_OVERSAMPLING_YAW)
73		73
74	/*	74	/*
75	* The value of gyro[PITCH/ROLL] for one deg/s = The hardware factor H * the number of samples * multiplier factor.	75	* The value of gyro[PITCH/ROLL] for one deg/s = The hardware factor H * the number of samples * multiplier factor.
76	* Will be about 10 or so for InvenSense, and about 33 for ADXRS610.	76	* Will be about 10 or so for InvenSense, and about 33 for ADXRS610.
77	*/	77	*/
78		78
79	/*	79	/*
80	* Gyro saturation prevention.	80	* Gyro saturation prevention.
81	*/	81	*/
82	// How far from the end of its range a gyro is considered near-saturated.	82	// How far from the end of its range a gyro is considered near-saturated.
83	#define SENSOR_MIN_PITCHROLL 32	83	#define SENSOR_MIN_PITCHROLL 32
84	// Other end of the range (calculated)	84	// Other end of the range (calculated)
85	#define SENSOR_MAX_PITCHROLL (GYRO_OVERSAMPLING_PITCHROLL * 1023 - SENSOR_MIN_PITCHROLL)	85	#define SENSOR_MAX_PITCHROLL (GYRO_OVERSAMPLING_PITCHROLL * 1023 - SENSOR_MIN_PITCHROLL)
86	// Max. boost to add "virtually" to gyro signal at total saturation.	86	// Max. boost to add "virtually" to gyro signal at total saturation.
87	#define EXTRAPOLATION_LIMIT 2500	87	#define EXTRAPOLATION_LIMIT 2500
88	// Slope of the boost (calculated)	88	// Slope of the boost (calculated)
89	#define EXTRAPOLATION_SLOPE (EXTRAPOLATION_LIMIT/SENSOR_MIN_PITCHROLL)	89	#define EXTRAPOLATION_SLOPE (EXTRAPOLATION_LIMIT/SENSOR_MIN_PITCHROLL)
90		90
91	/*	91	/*
92	* This value is subtracted from the gyro noise measurement in each iteration,	92	* This value is subtracted from the gyro noise measurement in each iteration,
93	* making it return towards zero.	93	* making it return towards zero.
94	*/	94	*/
95	#define GYRO_NOISE_MEASUREMENT_DAMPING 5	95	#define GYRO_NOISE_MEASUREMENT_DAMPING 5
96		96
97	#define PITCH 0	97	#define PITCH 0
98	#define ROLL 1	98	#define ROLL 1
99	#define YAW 2	99	#define YAW 2
100	#define Z 2	100	#define Z 2
101	/*	101	/*
102	* The values that this module outputs	102	* The values that this module outputs
103	* These first 2 exported arrays are zero-offset. The "PID" ones are used	103	* These first 2 exported arrays are zero-offset. The "PID" ones are used
104	* in the attitude control as rotation rates. The "ATT" ones are for	104	* in the attitude control as rotation rates. The "ATT" ones are for
105	* integration to angles. For the same axis, the PID and ATT variables	105	* integration to angles. For the same axis, the PID and ATT variables
106	* generally have about the same values. There are just some differences	106	* generally have about the same values. There are just some differences
107	* in filtering, and when a gyro becomes near saturated.	107	* in filtering, and when a gyro becomes near saturated.
108	* Maybe this distinction is not really necessary.	108	* Maybe this distinction is not really necessary.
109	*/	109	*/
110	extern int16_t gyro_PID[2];	110	extern int16_t gyro_PID[2];
111	extern int16_t gyro_ATT[2];	111	extern int16_t gyro_ATT[2];
112	extern int16_t gyroD[2];	112	extern int16_t gyroD[2];
113	extern int16_t yawGyro;	113	extern int16_t yawGyro;
114	extern volatile uint16_t ADCycleCount;	114	extern volatile uint16_t ADCycleCount;
115	extern int16_t UBat;	115	extern int16_t UBat;
116		116
117	// 1:11 voltage divider, 1024 counts per 3V, and result is divided by 3.	117	// 1:11 voltage divider, 1024 counts per 3V, and result is divided by 3.
118	#define UBAT_AT_5V (int16_t)((5.0 * (1.0/11.0)) * 1024 / (3.0 * 3))	118	#define UBAT_AT_5V (int16_t)((5.0 * (1.0/11.0)) * 1024 / (3.0 * 3))
119		119
120	extern sensorOffset_t gyroOffset;	120	extern sensorOffset_t gyroOffset;
121	extern sensorOffset_t accOffset;	121	extern sensorOffset_t accOffset;
122	extern sensorOffset_t gyroAmplifierOffset;	122	extern sensorOffset_t gyroAmplifierOffset;
123		123
124	/*	124	/*
125	* This is not really for external use - but the ENC-03 gyro modules needs it.	125	* This is not really for external use - but the ENC-03 gyro modules needs it.
126	*/	126	*/
127	//extern volatile int16_t rawGyroSum[3];	127	//extern volatile int16_t rawGyroSum[3];
128		128
129	/*	129	/*
130	* The acceleration values that this module outputs. They are zero based.	130	* The acceleration values that this module outputs. They are zero based.
131	*/	131	*/
132	extern int16_t acc[3];	132	extern int16_t acc[3];
133	extern int16_t filteredAcc[3];	133	extern int16_t filteredAcc[3];
134	// extern volatile int32_t stronglyFilteredAcc[3];	134	// extern volatile int32_t stronglyFilteredAcc[3];
135		135
136	/*	136	/*
137	* Diagnostics: Gyro noise level because of motor vibrations. The variables	137	* Diagnostics: Gyro noise level because of motor vibrations. The variables
138	* only really reflect the noise level when the copter stands still but with	138	* only really reflect the noise level when the copter stands still but with
139	* its motors running.	139	* its motors running.
140	*/	140	*/
141	extern uint16_t gyroNoisePeak[3];	141	extern uint16_t gyroNoisePeak[3];
142	extern uint16_t accNoisePeak[3];	142	extern uint16_t accNoisePeak[3];
143		143
144	/*	144	/*
145	* Air pressure.	145	* Air pressure.
146	* The sensor has a sensitivity of 45 mV/kPa.	146	* The sensor has a sensitivity of 45 mV/kPa.
147	* An approximate p(h) formula is = p(h[m])[kPa] = p_0 - 11.95 * 10^-3 * h	147	* An approximate p(h) formula is = p(h[m])[kPa] = p_0 - 11.95 * 10^-3 * h
148	* p(h[m])[kPa] = 101.3 - 11.95 * 10^-3 * h	148	* p(h[m])[kPa] = 101.3 - 11.95 * 10^-3 * h
149	* 11.95 * 10^-3 * h = 101.3 - p[kPa]	149	* 11.95 * 10^-3 * h = 101.3 - p[kPa]
150	* h = (101.3 - p[kPa])/0.01195	150	* h = (101.3 - p[kPa])/0.01195
151	* That is: dV = -45 mV * 11.95 * 10^-3 dh = -0.53775 mV / m.	151	* That is: dV = -45 mV * 11.95 * 10^-3 dh = -0.53775 mV / m.
152	* That is, with 38.02 * 1.024 / 3 steps per mV: -7 steps / m	152	* That is, with 38.02 * 1.024 / 3 steps per mV: -7 steps / m
153		153
154	Display pressures	154	Display pressures
155	4165 mV-->1084.7	155	4165 mV-->1084.7
156	4090 mV-->1602.4 517.7	156	4090 mV-->1602.4 517.7
157	3877 mV-->3107.8 1503.4	157	3877 mV-->3107.8 1503.4
158		158
159	4165 mV-->1419.1	159	4165 mV-->1419.1
160	3503 mV-->208.1	160	3503 mV-->208.1
161	Diff.: 1211.0	161	Diff.: 1211.0
162		162
163	Calculated Vout = 5V(.009P-0.095) --> 5V .009P = Vout + 5V 0.095 --> P = (Vout + 5V 0.095)/(5V 0.009)	163	Calculated Vout = 5V(.009P-0.095) --> 5V .009P = Vout + 5V 0.095 --> P = (Vout + 5V 0.095)/(5V 0.009)
164	4165 mV = 5V(0.009P-0.095) P = 103.11 kPa h = -151.4m	164	4165 mV = 5V(0.009P-0.095) P = 103.11 kPa h = -151.4m
165	4090 mV = 5V(0.009P-0.095) P = 101.44 kPa h = -11.7m 139.7m	165	4090 mV = 5V(0.009P-0.095) P = 101.44 kPa h = -11.7m 139.7m
166	3877 mV = 5V(0.009P-0.095) P = 96.7 kPa h = 385m 396.7m	166	3877 mV = 5V(0.009P-0.095) P = 96.7 kPa h = 385m 396.7m
167		167
168	4165 mV = 5V(0.009P-0.095) P = 103.11 kPa h = -151.4m	168	4165 mV = 5V(0.009P-0.095) P = 103.11 kPa h = -151.4m
169	3503 mV = 5V(0.009P-0.095) P = 88.4 kPa h = 384m Diff: 1079.5m	169	3503 mV = 5V(0.009P-0.095) P = 88.4 kPa h = 384m Diff: 1079.5m
170	Pressure at sea level: 101.3 kPa. voltage: 5V * (0.009P-0.095) = 4.0835V	170	Pressure at sea level: 101.3 kPa. voltage: 5V * (0.009P-0.095) = 4.0835V
171	This is OCR2 = 143.15 at 1.5V in --> simple pressure =	171	This is OCR2 = 143.15 at 1.5V in --> simple pressure =
172	*/	172	*/
173		173
174	#define AIRPRESSURE_OVERSAMPLING 14	174	#define AIRPRESSURE_OVERSAMPLING 14
175	#define AIRPRESSURE_FILTER 8	175	#define AIRPRESSURE_FILTER 8
176	// Minimum A/D value before a range change is performed.	176	// Minimum A/D value before a range change is performed.
177	#define MIN_RAWPRESSURE (200 * 2)	177	#define MIN_RAWPRESSURE (200 * 2)
178	// Maximum A/D value before a range change is performed.	178	// Maximum A/D value before a range change is performed.
179	#define MAX_RAWPRESSURE (1023 * 2 - MIN_RAWPRESSURE)	179	#define MAX_RAWPRESSURE (1023 * 2 - MIN_RAWPRESSURE)
180		180
181	#define MIN_RANGES_EXTRAPOLATION 15	181	#define MIN_RANGES_EXTRAPOLATION 15
182	#define MAX_RANGES_EXTRAPOLATION 240	182	#define MAX_RANGES_EXTRAPOLATION 240
183		183
184	#define PRESSURE_EXTRAPOLATION_COEFF 25L	184	#define PRESSURE_EXTRAPOLATION_COEFF 25L
185	#define AUTORANGE_WAIT_FACTOR 1	185	#define AUTORANGE_WAIT_FACTOR 1
186		186
187	#define ABS_ALTITUDE_OFFSET 108205	187	#define ABS_ALTITUDE_OFFSET 108205
188		188
189	extern uint16_t simpleAirPressure;	189	extern uint16_t simpleAirPressure;
190	/*	190	/*
191	* At saturation, the filteredAirPressure may actually be (simulated) negative.	191	* At saturation, the filteredAirPressure may actually be (simulated) negative.
192	*/	192	*/
193	extern int32_t filteredAirPressure;	193	extern int32_t filteredAirPressure;
-		194
-		195	extern int16_t magneticHeading;
194		196
195	/*	197	/*
196	* Flag: Interrupt handler has done all A/D conversion and processing.	198	* Flag: Interrupt handler has done all A/D conversion and processing.
197	*/	199	*/
198	extern volatile uint8_t analogDataReady;	200	extern volatile uint8_t analogDataReady;
-		201
199		202
200	void analog_init(void);	203	void analog_init(void);
201		204
202	/*	205	/*
203	* This is really only for use for the ENC-03 code module, which needs to get the raw value	206	* This is really only for use for the ENC-03 code module, which needs to get the raw value
204	* for its calibration. The raw value should not be used for anything else.	207	* for its calibration. The raw value should not be used for anything else.
205	*/	208	*/
206	uint16_t rawGyroValue(uint8_t axis);	209	uint16_t rawGyroValue(uint8_t axis);
207		210
208	/*	211	/*
209	* Start the conversion cycle. It will stop automatically.	212	* Start the conversion cycle. It will stop automatically.
210	*/	213	*/
211	void startAnalogConversionCycle(void);	214	void startAnalogConversionCycle(void);
212		215
213	/*	216	/*
214	* Process the sensor data to update the exported variables. Must be called after each measurement cycle and before the data is used.	217	* Process the sensor data to update the exported variables. Must be called after each measurement cycle and before the data is used.
215	*/	218	*/
216	void analog_update(void);	219	void analog_update(void);
217		220
218	/*	221	/*
219	* Read gyro and acc.meter calibration from EEPROM.	222	* Read gyro and acc.meter calibration from EEPROM.
220	*/	223	*/
221	void analog_setNeutral(void);	224	void analog_setNeutral(void);
222		225
223	/*	226	/*
224	* Zero-offset gyros and write the calibration data to EEPROM.	227	* Zero-offset gyros and write the calibration data to EEPROM.
225	*/	228	*/
226	void analog_calibrateGyros(void);	229	void analog_calibrateGyros(void);
227		230
228	/*	231	/*
229	* Zero-offset accelerometers and write the calibration data to EEPROM.	232	* Zero-offset accelerometers and write the calibration data to EEPROM.
230	*/	233	*/
231	void analog_calibrateAcc(void);	234	void analog_calibrateAcc(void);
232		235
233		236
234	void analog_setGround(void);	237	void analog_setGround(void);
235		238
236	int32_t analog_getHeight(void);	239	int32_t analog_getHeight(void);
237	int16_t analog_getDHeight(void);	240	int16_t analog_getDHeight(void);
238		241
239	#endif //_ANALOG_H	242	#endif //_ANALOG_H
240		243