Diff: main.cpp

Revision:

2:9847e6e7ce2d

Parent:

1:d6bbefff36fa

Child:

3:a284535865b7

--- a/main.cpp	Mon Jul 05 16:58:26 2021 +0000
+++ b/main.cpp	Mon Jul 05 17:30:13 2021 +0000
@@ -18,15 +18,22 @@
 
 void gobeur_initialize()
 {
-    
+    gobeur_right_aspire_servo = 0;
+    gobeur_left_aspire_servo = 0;
+    wait(2);
+    gobeur_right_aspire_servo = 1.0;
+    gobeur_left_aspire_servo = 1.0;
+    wait(2);
+    gobeur_right_aspire_servo = 0;
+    gobeur_left_aspire_servo = 0;
     }
     
 int aspirateur_on(uint8_t gobeur_id) 
 {
     if(gobeur_id == 0)
-        gobeur_right_aspire_servo = 20;
+        gobeur_right_aspire_servo = 0.2;
     if(gobeur_id == 1)
-        gobeur_left_aspire_servo = 20;
+        gobeur_left_aspire_servo = 0.2;
 }
 
 int aspirateur_off(uint8_t gobeur_id)
@@ -45,9 +52,9 @@
 int block_gobelet(uint8_t gobeur_id) 
 {
     if(gobeur_id == 0)
-        gobeur_right_block_servo = 20;
+        gobeur_right_block_servo = 0.2;
     if(gobeur_id == 1)
-        gobeur_left_block_servo = 20;
+        gobeur_left_block_servo = 0.2;
 }
 int unblock_gobelet(uint8_t gobeur_id)
 {