added gy80 dcm
Dependencies: mbed DCM_AHRS_GY80 PID MMA8451Q
Fork of quadCommand by
quadCommand/quadCommand.h
- Committer:
- gabdo
- Date:
- 2013-06-10
- Revision:
- 40:8c01bf294768
- Parent:
- 20:4cdabb792d16
- Child:
- 43:e2fc699e8e8c
File content as of revision 40:8c01bf294768:
/************************* quadCommand.h *********************************/ /* */ /*************************************************************************/ #ifndef QUAD_COMMAND_H #define QUAD_COMMAND_H #include "mbed.h" #include "motor.h" #include "com.h" #include "sensors.h" #include "PID.h" // Motor constants. const PinName MOTOR1 = PTD4; // Pin used for motor 1. const PinName MOTOR2 = PTA12; // Pin used for motor 2. const PinName MOTOR3 = PTA4; // Pin used for motor 3. const PinName MOTOR4 = PTA5; // Pin used for motor 4. // Xbee constants. // Alternative Pins // RX = PTA1, TX PTA2 const PinName TXPIN = PTD3; // Pin used for xbee TX. const PinName RXPIN = PTD2; // Pin used for xbee RX. // Sensor constants. #define MMA8451_I2C_ADDRESS (0x1d<<1) // Address of I2C accelerometer. const PinName ACCSDA = PTE25; // Pin for accelerometer SDA line. const PinName ACCSCL = PTE24; // Pin for accelerometer SCL line. // PID constants. #define DEFAULT_WINDUP_GUARD 20.0f class quadCommand { public: quadCommand(); // Constructor. void run(); // Loop. void rxInput(); // Deal with new input from xbee. void updateMotors(); void sendTelemetry(); static const float MOTOR_UPDATE; private: motor *myMotors[4]; // Array of motor objects. com *myCom; // The com object. sensors *world; // Sensors used to observe the world. float currentThrottle; float currentPitch; float currentRoll; float currentYaw; float targetThrottle; float targetPitch; float targetRoll; float targetYaw; PID pidThrottle; PID pidPitch; PID pidRoll; PID pidYaw; }; #endif