Do NOT modify!
Dependencies: mbed Servo ServoArm
Fork of PES_Yanick by
Diff: Headers/Declarations.h
- Revision:
- 9:ac362674c480
diff -r 593f82e66bdf -r ac362674c480 Headers/Declarations.h --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Headers/Declarations.h Tue May 02 08:39:35 2017 +0000 @@ -0,0 +1,40 @@ +#ifndef DECLARATIONS_H +#define DECLARATIONS_H + +//DistanceSensors: +#define NEAR 0.18f //Used for distance Sensors. If they're to near to a wall -> turn +#define NEAR_LEGO 0.20f //If the DistanceSensors are near to a Lego... + +#define LEFT_L 5 //Arrayindex of the left LEGO Sensor & left LED +#define FWD_L 0 //Arrayindex of the front LEGO Sensor & front LED +#define RIGHT_L 1 //Arrayindex of the right LEGO Sensor & right LED + +#define LEFT 7 //Arrayindex of the left Sensor +#define FWD 6 //Arrayindex of the front Sensor +#define RIGHT 8 //Arrayindex of the right Sensor +#define BRIGHT 2 //Arrayindex of the backward right Sensor & left LED +#define BWD 3 //Arrayindex of the backward Sensor & front LED +#define BLEFT 4 //Arrayindex of the backsward left Sensor & right LED + +//ColorSensors: +#define RED_UPLIMIT 500 //Default limit in mV +#define GREEN_DOWNLIMIT 501 // +#define GREEN_UPLIMIT 1200 // + +#define GREEN 1 //Will be used to operate arm functions +#define NOBLOCK 0 // +#define RED -1 // + +//Greifer: +#define PC_7 SERVO0 + +//Arm +#define COLLECT_POS -65.0f +#define RELEASE_POS -80.0f +#define TAKE_POS +60.0f + +//Misc: +#define TIMEOUT 140 //if the timer reaches TIMEOUT ([TIMEOUT] = 0.1s), the robot will reset. +#define MAX 50 //Once the counter reaches MAX, it will turn around. + +#endif \ No newline at end of file