1 files changed, 34 insertions, 0 deletions
diff --git a/src/c/scilab-arduino/cmd_servo_move/u8cmd_servo_moves.cpp b/src/c/scilab-arduino/cmd_servo_move/u8cmd_servo_moves.cpp
new file mode 100644
index 00000000..c7c6fa7d
--- /dev/null
+++ b/src/c/scilab-arduino/cmd_servo_move/u8cmd_servo_moves.cpp
@@ -0,0 +1,34 @@
+/* Copyright (C) 2016 - IIT Bombay - FOSSEE
+
+ This file must be used under the terms of the CeCILL.
+ This source file is licensed as described in the file COPYING, which
+ you should have received as part of this distribution.  The terms
+ are also available at
+ http://www.cecill.info/licences/Licence_CeCILL_V2-en.txt
+ Author: Mushir
+ Organization: FOSSEE, IIT Bombay
+ Email: toolbox@scilab.in
+*/
+
+#include "cmd_servo_move.h"
+#include "Arduino.h"
+#include<Servo.h>
+Servo servo1,servo2;
+void 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);
+            } 
+    }
+}
+