Diff: main.cpp

Revision:

0:2ef155ddb58d

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Tue Mar 17 13:55:49 2020 +0000
@@ -0,0 +1,34 @@
+#include "mbed.h"
+
+PwmOut servo90(p23);        //サーボSG90
+PwmOut servo92(p24);        //サーボSR92
+
+int main() {
+    servo92.period_ms(20);
+    servo90.period_ms(20);
+    wait(1);
+    float ang = 1000;
+    float kaku = 1300;
+    while(1) {
+        
+        for(ang = 1000; ang <= 1900; ang += 1){
+            servo92.pulsewidth_us(ang);
+            wait(0.001); // 1 ms
+        }
+            
+        for(kaku = 1300; kaku <= 1600; kaku += 1){
+            servo90.pulsewidth_us(kaku);
+            wait(0.001); // 1 ms
+        }
+            
+        for(ang = 1900; ang >= 1000; ang -= 1){
+            servo92.pulsewidth_us(ang);
+            wait(0.001); // 1 ms
+        }   
+            
+        for(kaku = 1600; kaku >= 1300; kaku -= 1){
+            servo90.pulsewidth_us(kaku);
+            wait(0.001); // 1 ms
+        }   
+    }
+}