a

Dependencies:   Servo ServoArm mbed

Fork of PES_Official-TestF by zhaw_st16b_pes2_10

Headers/Declarations.h

Committer:
beacon
Date:
2017-05-18
Revision:
17:4e1be70bdedb
Parent:
15:915f8839fe48

File content as of revision 17:4e1be70bdedb:

#ifndef DECLARATIONS_H
#define DECLARATIONS_H

//DistanceSensors:
#define NEAR 0.16f          //Used for distance Sensors. If they're to near to a wall -> turn
#define NEAR_LEGO 0.12f     //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 1400    //Default limit in mV
#define GREEN_DOWNLIMIT 1401//
#define GREEN_UPLIMIT 2000  //

#define GREEN 1             //Will be used to operate arm functions
#define NOBLOCK 0           //
#define RED 2               //

//Greifer:
//#define PC_7 SERVO0

//Arm
#define COLLECT_POS 60.0f
#define RELEASE_POS 85.0f
#define TAKE_POS -65.0f


//
#define UP_POS 20.0f //zu bestimmen
#define DOWN_POS -72.0f //zu bestimmen

//Misc:
#define TIMEOUT 1400        //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