Preston Ernst
/
mirror_actuator_VT
-data logging revision
Lib_Misc/Unwrapper.cpp
- Committer:
- ernstpre
- Date:
- 2021-08-24
- Revision:
- 2:92c25cb669f4
- Parent:
- 0:d2e117716219
File content as of revision 2:92c25cb669f4:
/* */ #include "Unwrapper.h" #define pi 3.141592653589793 using namespace std; Unwrapper::Unwrapper(double i2r) { inc2rad = i2r; last_value = 0; } Unwrapper::~Unwrapper() {} void Unwrapper::reset(void) { last_value = 0; } double Unwrapper::doStep(short inc) { long temp = inc; if((temp - last_value) > 32000) temp -= 0xFFFF; else if((temp - last_value) < -32000) temp += 0xFFFF; last_value = temp; return (temp*inc2rad); }