Support for Servo motor for Arduino. Support for'diag' in c

1 files changed, 26 insertions, 0 deletions

diff --git a/src/c/scilab-arduino/cmd_servo_attach/u8cmd_servo_attach.cpp b/src/c/scilab-arduino/cmd_servo_attach/u8cmd_servo_attach.cpp
new file mode 100644
index 00000000..a89363ba
--- /dev/null
+++ b/src/c/scilab-arduino/cmd_servo_attach/u8cmd_servo_attach.cpp
@@ -0,0 +1,26 @@
+/*
+ Scilab2C FOSSEE IIT BOMBAY
+ */
+
+#include "cmd_servo_attach.h"
+#include "Arduino.h"
+#include<Servo.h>
+Servo servo1,servo2;
+uint8 u8cmd_servo_attach(uint8 h,uint8 servo_no)
+{
+    // h -> Board no. reserve for future use
+    // servo_no -> pin no.(9 and 10).
+    if(servo_no == 1)
+       {
+        servo1.attach(9); 
+        servo1.write(0);
+       }
+    else
+       {
+        servo2.attach(10); 
+        servo2.write(0);    
+       }
+    
+    return 0;
+}
+