/branches/dongfang_FC_rewrite/invenSense.c |
---|
8,6 → 8,8 |
#define AUTOZERO_DDR DDRD |
#define AUTOZERO_BIT 5 |
const uint8_t GYROS_REVERSE[2] = {0,0}; |
void gyro_calibrate() { |
// If port not already set to output and high, do it. |
if (!(AUTOZERO_DDR & (1<<AUTOZERO_BIT)) || !(AUTOZERO_PORT & (1<<AUTOZERO_BIT))) { |