Subversion Repositories FlightCtrl

Compare Revisions

Ignore whitespace Rev 385 → Rev 386

/branches/v0.60_MicroMag3_Nick666/trunc/compass.c
244,6 → 244,16
// Winkelberechnung
heading = atan2_i(x_corr, y_corr);
/*
if (!x_corr && y_corr <0) return (90);
if (!x_corr && y_corr >0) return (270);
heading = atan(y_corr/x_corr)*57.29578;
if (x_corr < 0) heading = 180-heading;
if (x_corr > 0 && y_corr < 0) heading = -heading;
if (x_corr > 0 && y_corr > 0) heading = 360 - heading;
*/
 
return (heading);
}
/branches/v0.60_MicroMag3_Nick666/trunc/math.c
57,7 → 57,7
}
 
 
const float pgm_sinus_f [91] PROGMEM = {0.000,0.017,0.035,0.052,0.070,0.087,0.105,0.122,0.139,0.156,0.174,0.191,0.208,0.225,0.242,0.259,0.276,0.292,0.309,0.326,0.342,0.358,0.375,0.391,0.407,0.423,0.438,0.454,0.469,0.485,0.500,0.515,0.530,0.545,0.559,0.574,0.588,0.602,0.616,0.629,0.643,0.656,0.669,0.682,0.695,0.707,0.719,0.731,0.743,0.755,0.766,0.777,0.788,0.799,0.809,0.819,0.829,0.839,0.848,0.857,0.866,0.875,0.883,0.891,0.899,0.906,0.914,0.921,0.927,0.934,0.940,0.946,0.951,0.956,0.961,0.966,0.970,0.974,0.978,0.982,0.985,0.988,0.990,0.993,0.995,0.996,0.998,0.999,0.999,1.000,1.000};
const float pgm_sinus_f [91] PROGMEM = {0.0,0.01745241,0.03489950,0.05233595,0.06975647,0.08715574,0.10452846,0.12186934,0.13917310,0.15643446,0.17364817,0.19080899,0.20791168,0.22495105,0.24192189,0.25881904,0.27563735,0.29237170,0.30901699,0.32556815,0.34202013,0.35836794,0.37460658,0.39073112,0.40673663,0.42261825,0.43837113,0.45399049,0.46947155,0.48480961,0.49999999,0.51503806,0.52991925,0.54463902,0.55919289,0.57357642,0.58778524,0.60181501,0.61566146,0.62932038,0.64278759,0.65605901,0.66913059,0.68199834,0.69465835,0.70710676,0.71933978,0.73135368,0.74314481,0.75470956,0.76604443,0.77714594,0.78801074,0.79863549,0.80901698,0.81915203,0.82903756,0.83867055,0.84804808,0.85716728,0.86602539,0.87461969,0.88294758,0.89100651,0.89879403,0.90630777,0.91354544,0.92050484,0.92718384,0.93358041,0.93969261,0.94551856,0.95105650,0.95630474,0.96126169,0.96592582,0.97029572,0.97437006,0.97814759,0.98162718,0.98480775,0.98768833,0.99026806,0.99254615,0.99452189,0.99619469,0.99756405,0.99862953,0.99939083,0.99984769,1.0};
 
inline float pgm_read_float(const float *addr)
{