Travaux Pratiques » Polytech Ge SP4abc 2021

#include <stdio.h>

#include <stdlib.h>

#include <math.h>

struct position {

int latitude;

int longitude;

};

void decode_trame(char trame[1000], int* latitude, int* longitude);

float calcule_distance(struct position p_1,struct position p_2);

float calcule_vitesse(struct position p_1,struct position p_2);

void decode_trame(char trame[1000], int* latitude, int* longitude){

int i;

for(i = 17; i < 21;i++){

*latitude = *latitude*10 + (trame[i]-48);

}

for(i = 22; i < 26;i++){

*latitude = *latitude*10 + (trame[i]-48);

}

for(i = 29; i < 34;i++){

*longitude = *longitude*10 + (trame[i]-48);

}

for(i = 35; i < 39;i++){

*longitude = *longitude*10 + (trame[i]-48);

}

*latitude = *latitude - *latitude%1000000 + *latitude%1000000 * 5/3;

*longitude = *longitude - *longitude%1000000 + *longitude%1000000 * 5/3;

}

float calcule_distance(struct position p_1, struct position p_2){

float distance;

float lat1 = p_1.latitude;

float lat2 = p_2.latitude;

float lon1 = p_1.longitude;

float lon2 = p_2.longitude;

lat1 = lat1/1000000;

lat2 = lat2/1000000;

lon1 = lon1/1000000;

lon2 = lon2/1000000;

printf("LAT1 = %f\n", lat1);

printf("LON1 = %f\n", lon1);

printf("LAT2 = %f\n", lat2);

printf("LON2 = %f\n", lon2);

distance = acos(sin(lat1*M_PI/180)*sin(lat2*M_PI/180)+cos(lat1*M_PI/180)*cos(lat2*M_PI/180)*cos(lon1*M_PI/180-lon2*M_PI/180))*6371;

printf("D = %f\n", distance);

return distance;

}

float calcule_vitesse(struct position p_1, struct position p_2){

float distance;

float vitesse;

float lat1 = p_1.latitude;

float lat2 = p_2.latitude;

float lon1 = p_1.longitude;

float lon2 = p_2.longitude;

lat1 = lat1/1000000;

lat2 = lat2/1000000;

lon1 = lon1/1000000;

lon2 = lon2/1000000;

distance = acos(sin(lat1*M_PI/180)*sin(lat2*M_PI/180)+cos(lat1*M_PI/180)*cos(lat2*M_PI/180)*cos(lon1*M_PI/180-lon2*M_PI/180))*6371;

vitesse = distance * 3600;

printf("V = %f\n", vitesse);

return vitesse;

}

int main()

{

char trame1[] = {"$GPGGA,141914.00,4545.0000,N,00306.6036,E,1,05,3.4,499.3,M,,M,,*7D"};

char trame2[] = {"$GPGGA,141915.00,4545.0242,N,00306.6039,E,1,05,3.4,499.5,M,,M,,*72"};

struct position p_1,p_2;

p_1.longitude = 0;

p_1.latitude = 0;

p_2.longitude = 0;

p_2.latitude = 0;

decode_trame(trame1, &p_1.latitude, &p_1.longitude);

decode_trame(trame2, &p_2.latitude, &p_2.longitude);

calcule_distance(p_1, p_2);

calcule_vitesse(p_1, p_2);

printf("%d\n", p_1.latitude);

printf("%d\n", p_1.longitude);

printf("%d\n", p_2.latitude);

printf("%d\n", p_2.longitude);

return 0;

}

# depslib dependency file v1.0

1620232049 source:d:\tp_sp4_2021_leroy\sp4a12\tp2_sp4\main.c

<stdio.h>

<stdlib.h>

<math.h>

<?xml version="1.0" encoding="UTF-8" standalone="yes" ?>

<CodeBlocks_project_file>

<FileVersion major="1" minor="6" />

<Project>

<Option title="TP2_SP4" />

<Option pch_mode="2" />

<Option compiler="gcc" />

<Build>

<Target title="Debug">

<Option output="bin/Debug/TP2_SP4" prefix_auto="1" extension_auto="1" />

<Option object_output="obj/Debug/" />

<Option type="1" />

<Option compiler="gcc" />

<Compiler>

<Add option="-g" />

</Compiler>

</Target>

<Target title="Release">

<Option output="bin/Release/TP2_SP4" prefix_auto="1" extension_auto="1" />

<Option object_output="obj/Release/" />

<Option type="1" />

<Option compiler="gcc" />

<Compiler>

<Add option="-O2" />

</Compiler>

<Linker>

<Add option="-s" />

</Linker>

</Target>

</Build>

<Compiler>

<Add option="-Wall" />

</Compiler>

<Unit filename="main.c">

<Option compilerVar="CC" />

</Unit>

<Extensions>

<code_completion />

<envvars />

<debugger />

</Extensions>

</Project>

</CodeBlocks_project_file>