working-est copy with class-based code. still open loop
Fork of analoghalls6 by
Diff: positionsensors.cpp
- Revision:
- 5:ee1e6c84c302
- Parent:
- 1:1f58bdcf2956
- Child:
- 7:76d6ceb23e0d
--- a/positionsensors.cpp Mon Mar 02 11:17:15 2015 +0000 +++ b/positionsensors.cpp Tue Mar 03 06:28:10 2015 +0000 @@ -40,6 +40,17 @@ angle -= _offset; if (angle < 0.0f) angle += 360.0f; if (angle >= 360.0f) angle -= 360.0f; + /* + #ifdef __DEBUG + pc->printf("%f",angle); + pc->printf("\t"); + pc->printf("%f",ascaled); + pc->printf("\t"); + pc->printf("%f",bscaled); + pc->printf("\t"); + pc->printf("\n\r"); + #endif + */ return angle; } \ No newline at end of file