X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=ao_convert.c;h=2585db54264586818b68ca538f3525144f538587;hp=08f628b46be7a6161d19a05813521f87b0525e3a;hb=43c8f7012102cdb591ace899420c10e4a78385ad;hpb=5be13b76a2e29b84cd6d1eec065e3354b0dafce5 diff --git a/ao_convert.c b/ao_convert.c index 08f628b4..2585db54 100644 --- a/ao_convert.c +++ b/ao_convert.c @@ -44,4 +44,8 @@ ao_temp_to_dC(int16_t temp) __reentrant } int16_t -ao_accel_to_cm_per_s2(int16_t accel) __reentrant; +ao_accel_to_cm_per_s2(int16_t accel) __reentrant +{ + /* this is wrong */ + return (998 - (accel >> 4)) * 3300 / 2047; +}