goncalves/Projet_Voilier
2
2
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

Roulis v4

Browse source
This commit is contained in:
leo 2025-11-25 17:40:36 +01:00
parent 192147aa9e
commit 9e198138da
1 changed files with 9 additions and 8 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

17
Services/roulis.c
View file

@ -4,7 +4,8 @@
#include <MySPI.h> #include <MySPI.h>
#include <MyTimer.h> #include <MyTimer.h>
char x1,x2,y1,y2,z1,z2; //char x1,x2
char y1,y2,z1,z2;
void MyRoulis_Init(void){ void MyRoulis_Init(void){
MySPI_Init(SPI1); MySPI_Init(SPI1);
@ -33,11 +34,11 @@ void MyRoulis_Init(void){
void MyRoulis_Data(void){ void MyRoulis_Data(void){
// Récupération des registred DATAX0..DATAZ1 (6 registres) // Récupération des registred DATAX0..DATAZ1 (6 registres)
MySPI_Clear_NSS(); // Début transmission X // MySPI_Clear_NSS(); // Début transmission X
MySPI_Send((0x32)|(0<<7)|(1<<6)); // On veut lire les 2 bytes DATAX // MySPI_Send((0x32)|(0<<7)|(1<<6)); // On veut lire les 2 bytes DATAX
x1 = MySPI_Read(); // premier byte // x1 = MySPI_Read(); // premier byte
x2 = MySPI_Read(); // deuxième byte // x2 = MySPI_Read(); // deuxième byte
MySPI_Set_NSS(); // Fin transmission X // MySPI_Set_NSS(); // Fin transmission X
MySPI_Clear_NSS(); // Début transmission Y MySPI_Clear_NSS(); // Début transmission Y
MySPI_Send((0x34)|(0<<7)|(1<<6)); // On veut lire les 2 bytes DATAY MySPI_Send((0x34)|(0<<7)|(1<<6)); // On veut lire les 2 bytes DATAY
@ -54,9 +55,9 @@ void MyRoulis_Data(void){
float MyRoulis_Angle(){ float MyRoulis_Angle(){
//Calcul de l'angle alpha //Calcul de l'angle alpha
int x = x1 + (x2 << 8); //int x = x1 + (x2 << 8);
int y = y1 + (y2 << 8); int y = y1 + (y2 << 8);
int z = z1 + (z2 << 8); int z = z1 + (z2 << 8);
float alpha = atan( sqrtf(x*x + y*y) / z ); float alpha = atan(y / z); //sqrtf(x*x + y*y)
return alpha; return alpha;
} }