63 lines
1.2 KiB
C
63 lines
1.2 KiB
C
|
#include "pico/stdlib.h"
|
||
|
|
#include "gyro.h"
|
||
|
|
#include "gyro_ADXRS453.h"
|
||
|
|
#include "Log.h"
|
||
|
|
#include <stdio.h>
|
||
|
|
|
||
|
|
|
||
|
|
#define TEST_TIMEOUT_US 10000000
|
||
|
|
|
||
|
|
int test_gyro_vitesse_brute(void);
|
||
|
|
|
||
|
|
// Test du gyroscope
|
||
|
|
// 1 - lecture continue de la valeur brute de l'angle
|
||
|
|
|
||
|
|
int test_gyro(){
|
||
|
|
int lettre;
|
||
|
|
|
||
|
|
while(1){
|
||
|
|
|
||
|
|
do{
|
||
|
|
printf("A : Lecture brute\n");
|
||
|
|
printf("Q : Quitter\n");
|
||
|
|
|
||
|
|
lettre = getchar_timeout_us(TEST_TIMEOUT_US);
|
||
|
|
stdio_flush();
|
||
|
|
}while(lettre == PICO_ERROR_TIMEOUT ||lettre == 0);
|
||
|
|
|
||
|
|
switch(lettre){
|
||
|
|
|
||
|
|
case 'A':
|
||
|
|
case 'a':
|
||
|
|
while(test_gyro_vitesse_brute());
|
||
|
|
break;
|
||
|
|
|
||
|
|
case 'Q':
|
||
|
|
case 'q':
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void affichage(){
|
||
|
|
while(1){
|
||
|
|
Log_gestion();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
int test_gyro_vitesse_brute(void){
|
||
|
|
printf("Lecture vitesse brute\n");
|
||
|
|
uint16_t tampon_envoi[4];
|
||
|
|
uint8_t tampon_reception[4];
|
||
|
|
Log_init();
|
||
|
|
Gyro_init_spi();
|
||
|
|
Gyro_init_config();
|
||
|
|
|
||
|
|
struct t_angle_gyro angle_gyro;
|
||
|
|
printf("Debut acquisition\n");
|
||
|
|
while(1){
|
||
|
|
gyro_get_vitesse_brute(&angle_gyro, NULL);
|
||
|
|
printf("%2.2f rad\n", angle_gyro.rot_z);
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|