29/10/2019
Dependencies: Encoder_Nucleo_16_bits
Diff: PID.cpp
- Revision:
- 16:a8a0a1e3ddb1
- Parent:
- 15:5dfa92698884
- Child:
- 17:a5af05cade7e
--- a/PID.cpp Fri Oct 25 09:41:31 2019 +0000 +++ b/PID.cpp Tue Oct 29 16:47:10 2019 +0000 @@ -75,8 +75,8 @@ // As we use mm/s for speed unit and we convert all mesure to this unit // Converting step to millimeters - _measDistG = ((double)PositionG - (double)oldPositionG) / 54.881; - _measDistD = ((double)PositionD - (double)oldPositionD) / 54.881; + _measDistG = ((double)PositionG - (double)oldPositionG) / 42.415; + _measDistD = ((double)PositionD - (double)oldPositionD) / 42.415; // Converting position to speed _measSpeedG = 1000.0 * _measDistG;