main.c.svn-base

code to calculate a position of a robot using two laser mouse point on the ground.

#include "Odometrie.h"
#include <math.h>
#include <string.h>
#include <stdio.h>

int main(int argc, char **argv)
{
	pos_robot resultat;
	config_vecteur_position_ODI();
	resultat = odometrie();
	printf("\nx : %4.12lf, y: %4.12lf, orientation: %4.12lf\n", resultat.x, resultat.y, resultat.orientation);
	getchar();

	//printf("%4.12lf\n", my_modulo(456, 2*PI));
	//getchar();
	//printf("my_cos = %4.12lf : cos = %4.12lf\n", my_cos(-4), cos(-4));
	//printf("my_sin = %4.12lf : sin = %4.12lf\n", my_sin(-467), sin(-467));
	//printf("my_atan2 = %4.12lf : atan2 = %4.12lf\n", my_atan2(-0.19985665321321329798462132, 0.1235654687986541), atan2(-0.19985665321321329798462132, 0.1235654687986541));
	//printf("%4.16lf\t%4.16lf\n", my_sqrt(3)/2, sqrt(3)/2);
	
	return 0;
}