Mayu Wire Winding Setup With stepper motor ans Servos
Dependencies: BufferedSerial Servo X_NUCLEO_IHM01A1 mbed
Fork of WireWinding_Stepper by
Diff: main.cpp
- Revision:
- 25:7f8fd0790b13
- Parent:
- 24:77e407b5d247
- Child:
- 26:d6a21152f6cc
diff -r 77e407b5d247 -r 7f8fd0790b13 main.cpp --- a/main.cpp Mon May 23 13:52:57 2016 +0000 +++ b/main.cpp Mon May 23 14:23:19 2016 +0000 @@ -106,9 +106,10 @@ void ServoUpdate(){ int32_t Rotations=motor->GetPosition()/STEPS2Rotation; - int32_t amplitude=76; // number of rotation for full triangle wave 15/0.4/2*4 for 15 mm translation 0.4 wire diameter = + //int32_t amplitude=76; // number of rotation for full triangle wave 15/0.4/2*4 for 15 mm translation 0.4 wire diameter = + int32_t amplitude=64; // number of rotation for full triangle wave 15/0.4/2*4 for 15 mm translation 0.4 wire diameter = float Y_New=(float) (abs(Rotations%amplitude-amplitude/2)-amplitude/4); - float centr_Angle=0.30; // 0.55 minimum down , 0.05 minimum up. + float centr_Angle=0.25; // 0.55 minimum down , 0.05 minimum up. change 0.55-0.01 Last change- 0.53-0.01 0.50-0.0 float Angle_Amplitude=0.25f; float Angle=centr_Angle+(Y_New/(amplitude/4))*Angle_Amplitude;