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

1 files changed, 40 insertions, 0 deletions

diff --git a/src/c/matrixOperations/diag/i16diaga.c b/src/c/matrixOperations/diag/i16diaga.c
new file mode 100644
index 0000000..29f9290
--- /dev/null
+++ b/src/c/matrixOperations/diag/i16diaga.c
@@ -0,0 +1,40 @@
+/*
+ * Scilab ( http://www.scilab.org/ ) - This file is part of Scilab
+ * Copyright (C) 2008-2008 - INRIA - Allan SIMON
+ *
+ * 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
+ *
+ */
+
+#include "diag.h"
+#include<stdlib.h>  // Used for Absolute value of insert_post
+void i16diaga(int16 in, int size,int insert_post,int16 *out)
+{
+    
+     int i;
+    
+      for(i=0;i < ((size+abs(insert_post))*(size+abs(insert_post)));i++)
+      {
+         out[i] = 0; 
+  
+      }
+    
+       if(insert_post < 0)
+	{
+      	   
+           out[abs(insert_post)] = in;
+          
+	}
+    else
+	{
+     
+          out[(size + insert_post)*insert_post] = in;
+      	
+    	}
+
+}
+