jetfishteam / Mbed 2 deprecated robotic_fish_ver_4_9_pixy

My modifications/additions to the code

Dependencies:   ADXL345 ADXL345_I2C IMUfilter ITG3200 Servo fishgait mbed-rtos mbed pixy_cam

Fork of robotic_fish_ver_4_8 by jetfishteam

Files at this revision

API Documentation at this revision

Revision 9:8dd7a76756e2, committed 2014-01-31

Comitter:
rkk
Date:
Fri Jan 31 04:53:10 2014 +0000
Parent:
8:0574a5db1fc4
Child:
10:d9f1037f0cb0
Commit message:
added more code to the sinusoidal driving

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
motor_controller.cpp Show annotated file Show diff for this revision Revisions of this file 
--- a/main.cpp	Fri Jan 31 04:33:44 2014 +0000
+++ b/main.cpp	Fri Jan 31 04:53:10 2014 +0000
@@ -48,7 +48,7 @@
         mcon.drive_sinusoidal(t.read(), vol_norm*freq_norm, 3*freq_norm);
         //pc.printf("time: %f\n\r", t.read());
         //pc.printf("throttle: %f frequency: %f rudder: %f\n\r",throttle,frequency,rudder);
-        wait_ms(1);
+        wait_ms(20);
     }
     t.stop();
 }

--- a/motor_controller.cpp	Fri Jan 31 04:33:44 2014 +0000
+++ b/motor_controller.cpp	Fri Jan 31 04:53:10 2014 +0000
@@ -64,9 +64,24 @@
 {
    float ome2 = 2.0* MATH_PI * frequency;
    float divisor = (ome2*currentTime);
-   float phi2 = asin(amp1/amplitude*sin(ome1 * currentTime + phi1))/divisor;
+   float dutycycle;
+   float phi2;
+   if(divisor > 0.0 && amplitude > 0.0)
+   {
+   phi2 = asin(amp1/amplitude*sin(ome1 * currentTime + phi1))/divisor;
+   dutycycle = amplitude*sin(ome2 * currentTime + phi2);
+   phi1 = phi2;
+   }
+   else{
+   dutycycle = 0.0;
+   }
+   setpolarspeed(dutycycle);
    
-   setpolarspeed(amplitude*sin(ome2 * currentTime + phi2));
+   //set previous values
+   ome1 = ome2;
+   
+   amp1 = amplitude;
+   
    return;
 }