sensortask.h

来自「AVR单片机做的两轮自平衡机器人」· C头文件 代码 · 共 15 行

/*
 SensorTask.h

 */
#define FRAC(H) ((int)((H)*16))

extern long iAngle;
extern int iTenthsDegree;

#define GYROOFFSET FRAC(565.875)
#define ANGLEGAIN FRAC(89.5)

void SetAngle(int iTenths);
void AdjustAngle(int iTenths);