Dave Lu
/
FYDP
IMU and knee angle. No servo yet
Fork of FYDP_Final2 by
robot.cpp
- Committer:
- tntmarket
- Date:
- 2015-03-25
- Revision:
- 11:425dff6a4af9
- Parent:
- 6:b3baf0fe5b73
File content as of revision 11:425dff6a4af9:
#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; }