ROBOTIC COMPETITION PARIS 2017

Dependencies:   CMPS03 mbed

Fork of _test_suivi_mur by christophe vermaelen

fct.h

Committer:
syasya
Date:
2018-01-22
Revision:
13:4fdd8ad91c69
Parent:
12:6151eb503170

File content as of revision 13:4fdd8ad91c69:

#ifndef FCT_H
#define FCT_H

#include "CMPS03.h"
#include "mbed.h"

//GLOBALES
extern BusOut leds;
extern DigitalIn  jack;
extern DigitalIn capt2;
extern DigitalIn capt1;
extern DigitalOut smoke;
extern DigitalOut trigger1;
extern DigitalOut trigger2;
extern DigitalOut trigger3;
extern InterruptIn echo;
extern AnalogIn AnaG;
extern AnalogIn AnaAV;
extern PwmOut servo;
extern PwmOut MG; //vitesse moteur gauche
extern PwmOut MD; //vitesse moteur droit
extern DigitalOut sensMG;  // sens moteur gauche
extern DigitalOut sensMD;  // sens moteur droit
extern Timer temp,t,t2,t3,t4,t5;
extern Ticker tic1,tic2,tic3;
extern CMPS03 boussole;

extern int nombre;
extern int capt,capt_memo;
extern int etat,t3_set;
extern int drap,flag1,flag2,flag3,flag4,flag5;
extern float US1,US2,US3,AN1,AN2,US1_av,US2_av,US3_av,AN1_av,AN2_av,AN3; 
extern float E_av,E,iE,E0,E1;
extern float cmdG,cmdD;
extern float iecart,ecart_av,ecart;
extern float bearing,bearing_set,bearing_turn;


//CONSTANTES 
#define PERIOD 0.0001
#define VMAX 60
#define VLIMIT 70
#define Kp_dist 0.2
#define Kp_ecart 0.22
#define a 24.0
#define b 0.1

//PROTOTYPES
void en_avant();
void start_trig();
void stop_trig();
void stop();
void init();
void suivi_mur();
void suivi_mur_dist();
void contournement();
void rotation_horaire();
void rotation_sharp();
void fcttrig();
void mesAN();
void ballon();
void fume();

float vitesse(float);

#endif