Dave Lu / Mbed 2 deprecated FYDP

IMU and knee angle. No servo yet

Dependencies:   mbed

Fork of FYDP_Final2 by Dave Lu

robot.cpp

Committer:
tntmarket
Date:
2015-03-25
Revision:
6:b3baf0fe5b73

File content as of revision 6:b3baf0fe5b73:

#include "robot.h"

DigitalOut led(LED_PIN);

MPU6050 mpu;
MPU6051 mpu2;
DigitalOut imuSwitch(IMU_POWER_PIN);
DigitalOut imu2Switch(IMU2_POWER_PIN);
IMU_DATA imu_data;
IMU_DATA imu2_data;

Timer t;

float getTime() { return (float)(t.read_us())/1000000; }