Diff: main.cpp

Revision:

2:0db7cc5ad6db

Parent:

1:63c28aae78c9

Child:

3:dadfc15fc2d1

--- a/main.cpp	Fri Feb 10 22:12:41 2017 +0000
+++ b/main.cpp	Mon Feb 20 02:42:27 2017 +0000
@@ -1,25 +1,44 @@
 #include "mbed.h"
-#include "tsi_sensor.h"
+#include "Servo.h"
+
+//Servo myServo(PTD4);
+//
+//int main(){
+//    while(1){  
+//        for(float p=0; p<1.0; p += 0.1) {
+//            myServo = p;
+//            wait(0.2);
+//        }
+//    }
+//}
+    
 
-/* This defines will be replaced by PinNames soon */
-#if defined (TARGET_KL25Z) || defined (TARGET_KL46Z)
-  #define ELEC0 9
-  #define ELEC1 10
-#elif defined (TARGET_KL05Z)
-  #define ELEC0 9
-  #define ELEC1 8
-#else
-  #error TARGET NOT DEFINED
-#endif
-
-//Erik's Comment
-
-int main(void) {
-    PwmOut led(LED_GREEN);
-    TSIAnalogSlider tsi(ELEC0, ELEC1, 40);
-    
-    while (true) {
-        led = 1.0 - tsi.readPercentage();
-        wait(0.1);
+ 
+PwmOut servo(PTD4);
+PwmOut leftMotor(PTA12);
+PwmOut rightMotor(PTA4);
+DigitalOut DIR_L(PTC4);
+DigitalOut DIR_R(PTC5);
+ 
+int main() {    
+    leftMotor.period_us(50);
+    rightMotor.period_us(50);
+    leftMotor.write(0.25);
+    rightMotor.write(0.25);
+    DIR_L = 0;
+    DIR_R = 1;
+    while(1){
+        
+        //for(float p=0.0001f; p<=0.0015f; p += 0.00005f) {
+//            //servo.period(0.020f);
+//            servo.pulsewidth(p);
+//            wait(0.05);
+//        }
+//        for(float p=0.0015f; p>=0.0001f; p -= 0.00005f) {
+//            //servo.period(0.020f); 
+//            servo.pulsewidth(p);
+//            wait(0.05);
+//        }
+        
     }
-}
+}
\ No newline at end of file