ARES / Mbed 2 deprecated Timer

Time is good

Dependencies:   RoboClaw mbed

Fork of Robot2016_2-0 by ARES

Map/Objectif/objectif.cpp

Committer:
IceTeam
Date:
2016-05-04
Revision:
66:47353c8122de
Parent:
64:24e1057a97f7
Child:
70:d70a6db1f635

File content as of revision 66:47353c8122de:

#include "objectif.h"

/* Dernier Changement : Romain 0h20 */

objectif::objectif (int ntype, float nx_obj, float ny_obj, float nthet_obj, Odometry * nCodo, AX12 * np, ControlleurPince * npince, float arr) {
	Parasol = np;
	pince = npince;
	type = ntype;
	x_objectif = nx_obj;
	y_objectif = ny_obj;
	thet_objectif = nthet_obj;
	Codo = nCodo;
	marche_arriere = arr;
}

bool objectif::Action () {
	switch(type) {
		case OBJ_BLOC:
			return obj_bloc_action();
			break;
		case OBJ_PARA:
			return obj_para_action();
			break;
		default:
			break;
	}

	if (marche_arriere != 0) {
		Codo->GotoDist(-marche_arriere);
	}
}

bool objectif::obj_bloc_action () {
	/* Range : 0 -> 10 (cm). pince.home remet à 0 */
	pince->home();
	pince->setPos(3,0,0);
}

bool objectif::obj_para_action() {
	return true;
}