|
|
|
|
@ -45,24 +45,24 @@ void do_kraftsensor(){
|
|
|
|
|
|
|
|
|
|
//kraftsensor_value = tmp;
|
|
|
|
|
/* conversion magic to milliNewton */
|
|
|
|
|
kraftsensor_read = ((tmp + 197700 /*539363*/)*9.81)/177.380;
|
|
|
|
|
|
|
|
|
|
if(abs(kraftsensor_read - old_value) > 10000){
|
|
|
|
|
if(abs(last_read - kraftsensor_read) > 10000){
|
|
|
|
|
kraftsensor_value = old_value;
|
|
|
|
|
//printf("delta: %ld\tvalue:%ld\n", kraftsensor_read - old_value, kraftsensor_read);
|
|
|
|
|
//printf("spike\n");
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
kraftsensor_value = kraftsensor_read;
|
|
|
|
|
//printf("jump\n");
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
kraftsensor_value = kraftsensor_read;
|
|
|
|
|
}
|
|
|
|
|
last_read = kraftsensor_read;
|
|
|
|
|
old_value = kraftsensor_value;
|
|
|
|
|
kraftsensor_value = ((tmp + 197700 /*539363*/)*9.81)/177.380;
|
|
|
|
|
|
|
|
|
|
//if(abs(kraftsensor_read - old_value) > 10000){
|
|
|
|
|
// if(abs(last_read - kraftsensor_read) > 10000){
|
|
|
|
|
// kraftsensor_value = old_value;
|
|
|
|
|
// //printf("delta: %ld\tvalue:%ld\n", kraftsensor_read - old_value, kraftsensor_read);
|
|
|
|
|
// //printf("spike\n");
|
|
|
|
|
// }
|
|
|
|
|
// else{
|
|
|
|
|
// kraftsensor_value = kraftsensor_read;
|
|
|
|
|
// //printf("jump\n");
|
|
|
|
|
// }
|
|
|
|
|
//}
|
|
|
|
|
//else{
|
|
|
|
|
// kraftsensor_value = kraftsensor_read;
|
|
|
|
|
//}
|
|
|
|
|
//last_read = kraftsensor_read;
|
|
|
|
|
//old_value = kraftsensor_value;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|