Commit e0c87b42 authored by Werner Sembach's avatar Werner Sembach
Browse files

Fix get max degree

parent 2a534a48
......@@ -5,7 +5,6 @@
#include <stdio.h>
#include <math.h>
#include <stm32f4/include/stm32f4xx_hal_conf.h>
#include <math.h>
#include "stm32f411e_discovery.h"
#include "stm32f411e_discovery_gyroscope.h"
......@@ -115,8 +114,6 @@ void get_degree() {
neigung_zu_lang_rad / M_PI, neigung_zu_lang_deg);
}
#define PWM_TIMER_TICKS_PER_MICROSECOND 84
double get_max_degree() {
int16_t xyz_accelero[3];
BSP_ACCELERO_GetXYZ(xyz_accelero);
......@@ -148,13 +145,11 @@ double get_max_degree() {
double neigung_zu_kurz_deg = neigung_zu_kurz_rad / M_PI * 180.;
double neigung_zu_lang_deg = neigung_zu_lang_rad / M_PI * 180.;
//ezs_printf("Neigung zu kurzer Seite: tan %6.1f rad %6.1fπ deg %6.1f°\n", neigung_zu_kurz_tan, neigung_zu_kurz_rad / M_PI, neigung_zu_kurz_deg);
//ezs_printf("Neigung zu langen Seite: tan %6.1f rad %6.1fπ deg %6.1f°\n", neigung_zu_lang_tan, neigung_zu_lang_rad / M_PI, neigung_zu_lang_deg);
if(neigung_zu_kurz_deg > neigung_zu_lang_deg){
return neigung_zu_kurz_deg;
if (fabs(neigung_zu_kurz_deg) > fabs(neigung_zu_lang_deg)) {
return fabs(neigung_zu_kurz_deg);
}
else{
return neigung_zu_lang_deg;
else {
return fabs(neigung_zu_lang_deg);
}
}
......
Supports Markdown
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment