Subversion Repositories FlightCtrl

Rev

Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
1612 dongfang 1
#include<inttypes.h>
2
#include "attitude.h"
3
 
4
/*
5
 * Angular unit scaling: Number of units per degree
6
 */
7
#define MATH_DRG_FACTOR GYRO_DEG_FACTOR_PITCHROLL
8
 
9
/*
10
 * Fix-point decimal scaling: Number of units for 1 (so if sin(something)
11
 * returns UNIT_FACTOR * 0.8, the result is to be understood as 0.8)
12
 * a * sin(b) = (a * int_sin(b * DRG_FACTOR)) / UNIT_FACTOR
13
 */
1775 - 14
//#define MATH_UNIT_FACTOR 8192
15
// Changed: We want to be able to multiply 2 sines/cosines and still stay comfortably (factor 100) within 31 bits.
16
// 4096 = 12 bits, square = 24 bits, 7 bits to spare.
2047 - 17
#define LOG_MATH_UNIT_FACTOR 12
18
#define MATH_UNIT_FACTOR (1L<<LOG_MATH_UNIT_FACTOR)
1612 dongfang 19
 
2044 - 20
int16_t sin_360(int16_t arg);
21
int16_t cos_360(int16_t arg);
22
int16_t tan_360(int16_t arg);
2048 - 23
 
24
void intervalWrap(int32_t *number, int32_t limit);