diff --git a/kraftsensor.c b/kraftsensor.c index de85659..621872b 100644 --- a/kraftsensor.c +++ b/kraftsensor.c @@ -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; } }