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

1 files changed, 24 insertions, 0 deletions

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