The subsystem design/basis for the final project
Dependencies: mbed-rtos mbed-src pixylib
global.h
- Committer:
- balsamfir
- Date:
- 2016-03-25
- Revision:
- 5:f655435d0782
- Parent:
- 3:dfb6733ae397
- Child:
- 6:52686c25e4af
File content as of revision 5:f655435d0782:
#include "mbed.h" #include "rtos.h" #include "Pixy.h" #include "PI.h" // ---------------------------------------------------------------- // Contains common defintions share between modes // ---------------------------------------------------------------- // Preprocessor Definitions // ---------------------------------------------------------------- #define MAX_BLOCKS 1 #define TARGET_DECIMAL 10 #define PWM_PERIOD 0.001 #define MOTOR_PERIOD 0.001 #define NAVIGATION_PERIOD 0.0167 // 60 times/sec #define MOTOR_KP 0.000120 #define MOTOR_KI 0.0000000001 #define STEERING_KP 0.01 #define STEERING_KI 0.005 #define SPEED_KP 0.01 #define SPEED_KI 0.01 #define SPEED_MAX 10 // Global variables // ---------------------------------------------------------------- // IO Port extern DigitalOut led1; extern DigitalOut led2; extern DigitalOut led3; extern DigitalOut led4; extern DigitalOut leftDir; extern DigitalOut rightDir; extern DigitalOut spiReset; extern DigitalOut ioReset; // Comunication extern SPI deSpi; extern Pixy pixy; extern Serial pc; // PC serial channel extern Serial bt; // Bluetooth serial channel // Control extern PI leftMotorPi; extern PI rightMotorPi; extern PI targetHeightPi; extern PI targetXPi; // Other extern PwmOut leftPwm; extern PwmOut rightPwm; extern InterruptIn bumper; // External interrupt pin declared as Bumper // Method prototypes void PI(float error, float *output, float *integral, float kP, float kI, float bound); float QE2RadsPerSec(short counts, short time);