Bonjour,
je travail actuellement sur un système de prévention et d'alerte en cas d'accident dans une voiture, le projet comptera pour le Bac.
On ma donc confié la tâche de détecter un excès de vitesse dans une voiture grâce à un GPS. le GPS que j'ai à disposition est un grove gps et j'ai une arduino mega 2560.
A proprement parler, je ne dois pas dire quand la voiture roule a 130 km/h sur une route à 90 ( se serrait bien trop dur ^^' ) mais plutôt dire lorsque la vitesse du véhicule augmente trop brusquement par rapport à une vitesse initiale.
Donc, je suis parti du principe qu'il fallait que je calcule 2 vitesses et que je fasse la différence des 2 pour dire lorsque la voiture à une vitesse trop importante.
n'ayant pas de grosses compétences en arduino, j'ai pris un programme GPS permettant de calculer une distance par rapport à 2 points et je l'ai modifié.
int i = 1;
int message[100];
int inByte;
String str = "";
int index;
///// DISTANCE /////
///// Latitude A/////
int Degre;
int Minute;
int Seconde;
///// Longitude A/////
int Degre1;
int Minute1;
int Seconde1;
///// Latitude B/////
int Degre2;
int Minute2;
int Seconde2;
///// Longitude B/////
int Degre3;
int Minute3;
int Seconde3;
//// DISTANCE 1 ////
///// Latitude A/////
int Degre4;
int Minute4;
int Seconde4;
///// Longitude A/////
int Degre5;
int Minute5;
int Seconde5;
///// Latitude B/////
int Degre6;
int Minute6;
int Seconde6;
///// Longitude B/////
int Degre7;
int Minute7;
int Seconde7;
float Rayon_Geo = 6372.8;
const float pi = 3.14;
void setup()
{
// Lancement serial port
Serial.begin(9600);
Serial1.begin(9600);
}
void loop()
{
//Lire sur port 1, Envoyer sur port 0
if (Serial1.available() > 0)
{
str = Serial1.readStringUntil('\n');
i = 0;
index = str.indexOf("GPGGA");
if (index >= 0)
{
/////////////////////////////// DISTANCE //////////////////////////////
///// Position GPS DMS Latitude A /////
Degre = (str.substring(18, 20).toInt());
Minute = (str.substring(20, 22).toInt());
Seconde = (str.substring(23, 27).toInt());
///// Position GPS DMS Longitude A /////
Degre1 = (str.substring(32, 33).toInt());
Minute1 = (str.substring(33, 35).toInt());
Seconde1 = (str.substring(36, 40).toInt());
delay(4000); //delay entre le point A et le point B qui nous permet par la suite de calculer la vitesse
///// Position GPS DMS Latitude B /////
Degre2 = (str.substring(18, 20).toInt());
Minute2 = (str.substring(20, 22).toInt());
Seconde2 = (str.substring(23, 27).toInt());
///// Position GPS DMS Longitude B /////
Degre3 = (str.substring(32, 33).toInt());
Minute3 = (str.substring(33, 35).toInt());
Seconde3 = (str.substring(36, 40).toInt());
delay(5000); // le temps d'écart entre DISTANCE et DISTANCE 1 //
/////////////////////////////// DISTANCE 1 //////////////////////////////
///// Position GPS DMS Latitude A /////
Degre4 = (str.substring(18, 20).toInt());
Minute4 = (str.substring(20, 22).toInt());
Seconde4 = (str.substring(23, 27).toInt());
///// Position GPS DMS Longitude A /////
Degre5 = (str.substring(32, 33).toInt());
Minute5 = (str.substring(33, 35).toInt());
Seconde5 = (str.substring(36, 40).toInt());
delay(4000); //delay entre le point A et le point B qui nous permet par la suite de calculer la vitesse
///// Position GPS DMS Latitude B /////
Degre6 = (str.substring(18, 20).toInt());
Minute6 = (str.substring(20, 22).toInt());
Seconde6 = (str.substring(23, 27).toInt());
///// Position GPS DMS Longitude B /////
Degre7 = (str.substring(32, 33).toInt());
Minute7 = (str.substring(33, 35).toInt());
Seconde7 = (str.substring(36, 40).toInt());
}
}
///// Conversion DMS vers DD Latitude A /////
float pos_Lat_A = (((Degre) + (Minute / 60)) + ((Seconde / 100) / 3600));
///// Conversion DMS vers DD Longitude A /////
float pos_Longi_A = ((((Degre1) + (Minute1 / 60)) + ((Seconde1 / 100) / 3600)))*(-1);
///// Conversion DMS vers DD Longitude B /////
float pos_Lat_B = (((Degre2) + (Minute2 / 60)) + ((Seconde2 / 100) / 3600));
///// Conversion DMS vers DD Longitude B /////
float pos_Longi_B = ((((Degre3) + (Minute3 / 60)) + ((Seconde3 / 100) / 3600)))*(-1);
///// Calcul de distance entre deux points A et B/////
int Distance = (Rayon_Geo * acos(sin(pos_Lat_A) * sin(pos_Lat_B) + cos(pos_Lat_A) * cos(pos_Lat_B) * cos(pos_Longi_A - pos_Longi_B)));
///// Calcul de la vitesse /////
int Speed = Distance / 4;
///// Conversion DMS vers DD Latitude A /////
float pos_Lat_A1 = (((Degre4) + (Minute4 / 60)) + ((Seconde4 / 100) / 3600));
///// Conversion DMS vers DD Longitude A /////
float pos_Longi_A1 = ((((Degre5) + (Minute5 / 60)) + ((Seconde5 / 100) / 3600)))*(-1);
///// Conversion DMS vers DD Longitude B /////
float pos_Lat_B1 = (((Degre6) + (Minute6 / 60)) + ((Seconde6 / 100) / 3600));
///// Conversion DMS vers DD Longitude B /////
float pos_Longi_B1 = ((((Degre7) + (Minute7 / 60)) + ((Seconde7 / 100) / 3600)))*(-1);
///// Calcul de distance entre deux points A et B/////
int Distance1 = (Rayon_Geo * acos(sin(pos_Lat_A1) * sin(pos_Lat_B1) + cos(pos_Lat_A1) * cos(pos_Lat_B1) * cos(pos_Longi_A1 - pos_Longi_B1)));
///// Calcul de la vitesse /////
int Speed1 = Distance1 / 4;
int Difference = Speed - Speed1;
if (Difference <= -10);
{
Serial.print("Le vehicule va trop vite");
Serial.println();
}
}
Comme vous pouvez le voir, le programme est long, sans doute dû au fait que je répète plusieurs passages pour avoir 2 vitesses distinctes.
Au début, rien de spéciale , je déclare toute les valeurs nécessaires et je mets en place 2 liaisons séries.
Ensuite, comme le GPS affiche plusieurs ligne de caractères, il faut les filtrer pour seulement prendre les informations qui m'intéresse en l’occurrence la latitude et la longitude.
Je laisse un temps de 4 secondes entre les 2 points ( A et B ) pour ensuite appliquer la fameuse formule V = D/T
comme la latitude et la longitude sont en Dixième de milliseconde, je les converties en degrés décimale et ensuite j 'applique une formule trouvé sur internet pour calculer une distance par rapport à 2 points dans un plan ovale ( la terre en gros ). Le reste est facile à comprendre mais vous aurez sans doute remarqué que je répète plusieurs fois les même parties du programme. C'est la seul solution que j'ai trouvé pour avoir une distance 1 et une distance 2 qui ne soit pas identique.
Concrètement, je ne sais pas si mon programme marche, bien que je me doute qu'il y ait des erreurs.
Pour le tester, je me suis baladé dans mon jardin avec mon ordinateur portable+arduino+ GPS mais la distance ne devait pas être assez grande car je n'avait que des valeurs nuls. Pouvoir tester le programme en temps réel est un des problèmes.
Le deuxième étant que je me suis compliqué la tâche et ça se voit 
c'est pour ce la que j'aimerai donc savoir s'il était possible de simplifier mon programme ou si d'autres méthodes auquel je n’aurait pas pensé étaient envisageable avec le matériel que j'ai à disposition.
