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

1 files changed, 27 insertions, 0 deletions

diff --git a/src/c/scilab-arduino/cmd_servo_move/u8cmd_servo_move.cpp b/src/c/scilab-arduino/cmd_servo_move/u8cmd_servo_move.cpp
new file mode 100644
index 0000000..e887476
--- /dev/null
+++ b/src/c/scilab-arduino/cmd_servo_move/u8cmd_servo_move.cpp
@@ -0,0 +1,27 @@
+/*
+ Scilab2C FOSSEE IIT BOMBAY
+ */
+
+#include "cmd_servo_move.h"
+#include "Arduino.h"
+#include<Servo.h>
+Servo servo1,servo2;
+uint8 u8cmd_servo_move(uint8 h,uint8 servo_no,uint8 val)
+{
+    // h -> Board no. reserve for future use
+    // servo_no -> pin no.(9 and 10).
+    //val -> 0 to 180 angle of rotation
+    if (val>=0 && val<=180)
+     {
+            if (servo_no==1)
+            {
+                servo1.write(val);
+            }
+            else if (servo_no==2) 
+            {
+               servo2.write(val);
+            } 
+    }
+    return 0;
+}
+