kopia lustrzana https://github.com/bristol-seds/pico-tracker
Added barometeric altitude model and testcase
Richard Meadows
rodzic
9fb5d6cb20
commit
7f58ddee7b
|
|
@ -0,0 +1,30 @@
|
||||||
|
/*
|
||||||
|
* Calcuates altitude in a International Standard Atmosphere
|
||||||
|
* Copyright (C) 2013 richard
|
||||||
|
*
|
||||||
|
* Permission is hereby granted, free of charge, to any person obtaining
|
||||||
|
* a copy of this software and associated documentation files (the
|
||||||
|
* "Software"), to deal in the Software without restriction, including
|
||||||
|
* without limitation the rights to use, copy, modify, merge, publish,
|
||||||
|
* distribute, sublicense, and/or sell copies of the Software, and to
|
||||||
|
* permit persons to whom the Software is furnished to do so, subject to
|
||||||
|
* the following conditions:
|
||||||
|
*
|
||||||
|
* The above copyright notice and this permission notice shall be
|
||||||
|
* included in all copies or substantial portions of the Software.
|
||||||
|
*
|
||||||
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||||
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
||||||
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
||||||
|
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
|
||||||
|
* LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
|
||||||
|
* OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
|
||||||
|
* WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef ALTITUDE_H
|
||||||
|
#define ALTITUDE_H
|
||||||
|
|
||||||
|
double pressure_to_altitude(double pr);
|
||||||
|
|
||||||
|
#endif /* ALTITUDE_H */
|
||||||
|
|
@ -0,0 +1,156 @@
|
||||||
|
/*
|
||||||
|
* Calcuates altitude in a International Standard Atmosphere
|
||||||
|
* Copyright (C) 2013 richard
|
||||||
|
*
|
||||||
|
* Permission is hereby granted, free of charge, to any person obtaining
|
||||||
|
* a copy of this software and associated documentation files (the
|
||||||
|
* "Software"), to deal in the Software without restriction, including
|
||||||
|
* without limitation the rights to use, copy, modify, merge, publish,
|
||||||
|
* distribute, sublicense, and/or sell copies of the Software, and to
|
||||||
|
* permit persons to whom the Software is furnished to do so, subject to
|
||||||
|
* the following conditions:
|
||||||
|
*
|
||||||
|
* The above copyright notice and this permission notice shall be
|
||||||
|
* included in all copies or substantial portions of the Software.
|
||||||
|
*
|
||||||
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||||
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
||||||
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
||||||
|
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
|
||||||
|
* LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
|
||||||
|
* OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
|
||||||
|
* WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <math.h>
|
||||||
|
|
||||||
|
#include "samd20.h"
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Useful Resources:
|
||||||
|
* Wikipedia: http://en.wikipedia.org/wiki/International_Standard_Atmosphere
|
||||||
|
* Wikipedia: http://en.wikipedia.org/wiki/Barometric_formula
|
||||||
|
*
|
||||||
|
* Online Calculator: http://www.digitaldutch.com/atmoscalc/
|
||||||
|
* (For Geopotential altitude, not Geometric)
|
||||||
|
*
|
||||||
|
* Mathematical Description: http://www.atmosculator.com/The%20Standard%20Atmosphere.html
|
||||||
|
*
|
||||||
|
* Test Data: http://www.wolframalpha.com/input/?i=air+pressure+at+11km+in+pascals
|
||||||
|
* (Works with Geometric altitude as you would expect, very clever)
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* Layer Heights h0 -> h7 (km) */
|
||||||
|
double h[] = { 0, 11, 20, 32, 47, 51, 71, 84.8520 };
|
||||||
|
/* Base Pressures p0 -> p7 (Pa) */
|
||||||
|
double p[] = { 101325, 22632.0, 5474.89, 868.019,
|
||||||
|
110.906, 66.9388, 3.95642, 0.373384 };
|
||||||
|
/* Lapse Rate l0 -> l7 (K/km) */
|
||||||
|
double l[] = { -6.5, 0, 1.0, 2.8, 0, -2.8, -2, 0 };
|
||||||
|
/* Base Temperatures t0 -> t7 (K) */
|
||||||
|
double t[] = { 288.15, 216.65, 216.65, 228.65,
|
||||||
|
270.65, 270.65, 214.65, 186.946 };
|
||||||
|
/* Gas Constant of Air (J/kgK) */
|
||||||
|
#define R 287.053
|
||||||
|
/* Gravity at 45° Latitude (m/s2) */
|
||||||
|
#define G -9.80665
|
||||||
|
/* Volumetric Mean Radius of the Earth (km) */
|
||||||
|
#define RE 6371
|
||||||
|
|
||||||
|
/* Scaling Function: Height (m) */
|
||||||
|
double hi(int i) { return h[i] * 1000; }
|
||||||
|
/* Scaling Function: Lapse Rate (K/m) */
|
||||||
|
double lr(int i) { return l[i] / 1000; }
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Returns the altitude within normal layer i at pressure pr.
|
||||||
|
*/
|
||||||
|
double normal_layer(double pr, int i) {
|
||||||
|
return hi(i) + (t[i] / lr(i)) * (pow(pr / p[i], (lr(i) * R) / G) - 1);
|
||||||
|
}
|
||||||
|
/**
|
||||||
|
* Returns the altitude within isothermic layer i at pressure pr.
|
||||||
|
*/
|
||||||
|
double isothermic_layer(double pr, int i) {
|
||||||
|
return hi(i) + ((R * t[i]) / G) * log(pr / p[i]);
|
||||||
|
}
|
||||||
|
/**
|
||||||
|
* Returns the geopotential altitude in meters of a given pressure in Pascals
|
||||||
|
*/
|
||||||
|
double geopotential_altitude(double pr) {
|
||||||
|
|
||||||
|
if (pr <= p[6]) { // Layer 6: Normal
|
||||||
|
return normal_layer(pr, 6);
|
||||||
|
|
||||||
|
} else if (pr <= p[5]) { // Layer 5: Normal
|
||||||
|
return normal_layer(pr, 5);
|
||||||
|
|
||||||
|
} else if (pr <= p[4]) { // Layer 4: Isothermic
|
||||||
|
return isothermic_layer(pr, 4);
|
||||||
|
|
||||||
|
} else if (pr <= p[3]) { // Layer 3: Normal
|
||||||
|
return normal_layer(pr, 3);
|
||||||
|
|
||||||
|
} else if (pr <= p[2]) { // Layer 2: Normal
|
||||||
|
return normal_layer(pr, 2);
|
||||||
|
|
||||||
|
} else if (pr <= p[1]) { // Layer 1: Isothermic
|
||||||
|
return isothermic_layer(pr, 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Layer 0: Normal
|
||||||
|
return normal_layer(pr, 0);
|
||||||
|
}
|
||||||
|
/**
|
||||||
|
* Returns the geometric altitude for a given pressure
|
||||||
|
*
|
||||||
|
* Pressure in Pascals
|
||||||
|
* Altitude in meters
|
||||||
|
*/
|
||||||
|
double pressure_to_altitude(double pr) {
|
||||||
|
double height = geopotential_altitude(pr);
|
||||||
|
|
||||||
|
return (height * (RE * 1000)) / ((RE * 1000) - height);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* #ifdef ALTITUDE_TEST */
|
||||||
|
|
||||||
|
/* #include <stdio.h> */
|
||||||
|
/* #include <stdlib.h> */
|
||||||
|
|
||||||
|
/* #define MAX_ERROR 10 */
|
||||||
|
|
||||||
|
/* void altitude_test(double altitude, uint32_t pressure) { */
|
||||||
|
/* double test_altitude = pressure_to_altitude(pressure); */
|
||||||
|
|
||||||
|
/* if (test_altitude > altitude - MAX_ERROR && */
|
||||||
|
/* test_altitude < altitude + MAX_ERROR) { // Success */
|
||||||
|
/* printf("%dPa = %gm (Expected %gm)\n", pressure, test_altitude, altitude); */
|
||||||
|
/* } else { // Fail */
|
||||||
|
/* printf("\nERROR:\n"); */
|
||||||
|
/* printf("%dPa = %gm (Expected %gm)\n", pressure, test_altitude, altitude); */
|
||||||
|
/* exit(1); */
|
||||||
|
/* } */
|
||||||
|
/* } */
|
||||||
|
|
||||||
|
/* int main(void) { */
|
||||||
|
/* printf("*** ALTITUDE_TEST ***\n\n"); */
|
||||||
|
|
||||||
|
/* printf("Data from Wolfram Alpha...\n\n"); */
|
||||||
|
/* altitude_test(-100, 102500); */
|
||||||
|
/* altitude_test( 0, 101300); */
|
||||||
|
/* altitude_test( 1000, 89880); */
|
||||||
|
/* altitude_test( 3000, 70120); */
|
||||||
|
/* altitude_test( 7000, 41110); */
|
||||||
|
/* altitude_test(11000, 22700); */
|
||||||
|
/* altitude_test(15000, 12110); */
|
||||||
|
/* altitude_test(20000, 5529); */
|
||||||
|
/* altitude_test(25000, 2549); */
|
||||||
|
/* altitude_test(30000, 1197); */
|
||||||
|
/* altitude_test(35000, 575); */
|
||||||
|
/* altitude_test(40000, 287); */
|
||||||
|
|
||||||
|
/* printf("\n*** DONE ***\n"); */
|
||||||
|
/* } */
|
||||||
|
|
||||||
|
/* #endif */
|
||||||
|
|
@ -0,0 +1,37 @@
|
||||||
|
#ifndef __verification__
|
||||||
|
#define __verification__
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/****************************//* barometric_altitude_tc *//****************************/
|
||||||
|
/**
|
||||||
|
* Write a description of your test case here
|
||||||
|
*/
|
||||||
|
#include "altitude.h"
|
||||||
|
|
||||||
|
/* Parameters in */
|
||||||
|
struct barometric_altitude_tc_params {
|
||||||
|
|
||||||
|
/* Input paramters to your test case go here */
|
||||||
|
float pressure; /* Pascals */
|
||||||
|
|
||||||
|
} barometric_altitude_tc_params;
|
||||||
|
/* Results out */
|
||||||
|
struct barometric_altitude_tc_results {
|
||||||
|
|
||||||
|
/* Result values should be populated here */
|
||||||
|
double altitude; /* meters */
|
||||||
|
|
||||||
|
} barometric_altitude_tc_results;
|
||||||
|
/* Function */
|
||||||
|
__verification__ void barometric_altitude_tc(void) {
|
||||||
|
|
||||||
|
/**
|
||||||
|
* The main body of the test case goes here.
|
||||||
|
*
|
||||||
|
* Use the input parameters to run the test case. Populate the
|
||||||
|
* results structure at the end
|
||||||
|
*/
|
||||||
|
|
||||||
|
barometric_altitude_tc_results.altitude =
|
||||||
|
pressure_to_altitude(barometric_altitude_tc_params.pressure);
|
||||||
|
}
|
||||||
|
|
@ -0,0 +1,49 @@
|
||||||
|
#!/usr/bin/env python
|
||||||
|
|
||||||
|
# ------------------------------------------------------------------------------
|
||||||
|
# Imports
|
||||||
|
# ------------------------------------------------------------------------------
|
||||||
|
|
||||||
|
import sys
|
||||||
|
sys.path.append("./test")
|
||||||
|
import main
|
||||||
|
|
||||||
|
from random import normalvariate
|
||||||
|
|
||||||
|
# ------------------------------------------------------------------------------
|
||||||
|
# Test Script
|
||||||
|
# ------------------------------------------------------------------------------
|
||||||
|
|
||||||
|
class barometric_altitude_tc:
|
||||||
|
def __init__(self):
|
||||||
|
self.name = self.__class__.__name__
|
||||||
|
self.iterations = 25
|
||||||
|
|
||||||
|
|
||||||
|
def get_test(self):
|
||||||
|
"""Returns some suitable test parameters"""
|
||||||
|
params = main.struct_barometric_altitude_tc_params()
|
||||||
|
|
||||||
|
"""
|
||||||
|
Assign input parameters here
|
||||||
|
"""
|
||||||
|
# Random barometeric pressure
|
||||||
|
params.pressure = abs(normalvariate(0, 80*1000))
|
||||||
|
|
||||||
|
return params
|
||||||
|
|
||||||
|
def is_correct(self, params, result, print_info):
|
||||||
|
"""Returns if a result is correct for the given parameters"""
|
||||||
|
|
||||||
|
"""
|
||||||
|
Compare result and params here, decide sth.
|
||||||
|
Can use print_info
|
||||||
|
"""
|
||||||
|
|
||||||
|
altitude = result['altitude']
|
||||||
|
|
||||||
|
print_info("Pressure: {:.1f} Pa, Altitude: {:.2f} meters".format(
|
||||||
|
params.pressure, float(altitude)))
|
||||||
|
print_info("")
|
||||||
|
|
||||||
|
return True
|
||||||
|
|
@ -49,6 +49,7 @@
|
||||||
#include "adc_battery_solar_read.h"
|
#include "adc_battery_solar_read.h"
|
||||||
#include "gps_baud_error.h"
|
#include "gps_baud_error.h"
|
||||||
#include "crc32_gen_buf.h"
|
#include "crc32_gen_buf.h"
|
||||||
|
#include "barometric_altitude.h"
|
||||||
/* [new_tc] */
|
/* [new_tc] */
|
||||||
|
|
||||||
|
|
||||||
|
|
|
||||||
Ładowanie…
Reference in New Issue