vf

Dependencies:   Servo ServoArm mbed

Fork of PES_Official by zhaw_st16b_pes2_10

Headers/Declarations.h

Committer:
EpicG10
Date:
2017-05-10
Revision:
13:6c1f8e35b242
Parent:
12:c0bcb95885dd
Child:
14:b61fbd13a7c9

File content as of revision 13:6c1f8e35b242:

#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 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

//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