Do NOT modify!

Dependencies:   mbed Servo ServoArm

Fork of PES_Yanick by zhaw_st16b_pes2_10

Headers/Declarations.h

Committer:
EpicG10
Date:
2017-05-02
Revision:
7:6fed0dcae9c1
Parent:
6:ba26dd3251b3
Child:
10:f76476943a6c

File content as of revision 7:6fed0dcae9c1:

#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