my_math.c

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

#include "my_math.h"

int my_sqrt_precision = 50;			//pr閏ision de la racine carr閑
int my_cos_precision = 16;			//pr閏ision du cosinus
int my_sin_precision = 16;			//pr閏ision du sinus
int my_atan_precision = 20;			//pr閏ision de atan

double my_sqrt(double acalculer)
{
	int i;
	double an, an1;
	an = acalculer;
	if(an != 0)
	{
		for (i=0;i<my_sqrt_precision;i++)
		{
			an1=(an+(acalculer)/an)/2;
			an=an1;
		}
	}
	return an;
}

double my_pow(double nombre, int puissance)
{
	int i;
	double resultat = 1;
	
	for(i = 0; i<puissance; i++)
	{
		resultat = resultat*nombre;
	}
	return resultat;
}

int my_fact(int nombre)
{
	int i, fact = 1;

	for(i = 1; i<=nombre; i++)
	{
		fact = fact * (i);
	}
	
	return fact;
}

double my_cos(double x) //Cette fonction cos marche avec des radians
{
	double cosinus = 0;
	int i;
	
	x = my_modulo(x, 2*PI); //ramene l'angle