The subsystem design/basis for the final project
Dependencies: mbed-rtos mbed-src pixylib
global.h
- Committer:
- balsamfir
- Date:
- 2016-04-07
- Revision:
- 18:501f1007a572
- Parent:
- 17:47e107f9587b
- Child:
- 19:05b8123905fb
File content as of revision 18:501f1007a572:
#include "mbed.h" #include "rtos.h" #include "Pixy.h" #include "PeriodicPI.h" // ---------------------------------------------------------------- // Contains common defintions share between modes // ---------------------------------------------------------------- // Preprocessor Definitions // ---------------------------------------------------------------- #define SPEED_MAX 40 // rads/s #define MAX_BLOCKS 1 #define X_SETPOINT 160 #define HEIGHT_SETPOINT 90 #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.0000001 #define STEERING_KP 0.10 #define STEERING_KI 0 #define SPEED_KP 0.6 #define SPEED_KI 0 #define MOTOR_SAMPLES 300 #define NAVIGATION_SAMPLES 240 // 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 // Control extern PeriodicPI leftMotorPI; extern PeriodicPI rightMotorPI; extern PeriodicPI heightPI; extern PeriodicPI xPI; // Other extern PwmOut leftPwm; extern PwmOut rightPwm; extern InterruptIn bumper; // External interrupt pin declared as Bumper // Method prototypes char flushBuffer(void); float QE2RadsPerSec(short counts, short time);