Do NOT modify!

Dependencies:   mbed Servo ServoArm

Fork of PES_Yanick by zhaw_st16b_pes2_10

Headers/Declarations.h

Committer:
beacon
Date:
2017-05-03
Revision:
10:f76476943a6c
Parent:
7:6fed0dcae9c1
Child:
12:c0bcb95885dd

File content as of revision 10:f76476943a6c:

#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 60.0f
#define RELEASE_POS 85.0f
#define TAKE_POS -65.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