senoide setpoint

Dependencies:   mbed Servo filter

Revision:
4:7d74fc55c844
Parent:
3:f850f53ff658
--- a/main.cpp	Tue Dec 03 03:44:05 2019 +0000
+++ b/main.cpp	Tue Dec 03 03:59:09 2019 +0000
@@ -159,7 +159,7 @@
             
             motorEsquerda.write((0.8*(0.5 - controlAction)));
             motorDireita.write(0.5 + controlAction);
-            pc.printf("A[%4d]U[%.2f]\r\n",angle_media,controlAction);    
+            pc.printf("A[%4d]U[%.2f]\r\n",angulo_media,controlAction);    
             
             
             //Se ele estiver subindo, mas subiu mais que o setpoint1, entao deve descer