TurtleBot
SD
Dependencies: mbed
Diff: main.cpp
- Revision:
- 0:9650aa5a106e
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Mon Apr 09 10:05:07 2018 +0000
@@ -0,0 +1,33 @@
+#include "mbed.h"
+#include "math.h"
+
+Serial pc(USBTX,USBRX);
+const int n = 5 ;
+float IMU[n] = {1,2,3,4,5};
+float sum = 0.00 ;
+float mean = 0.00 ;
+float standardDeviation = 0.00 ;
+
+void calculateSD(float IMU[]);
+
+int main()
+{
+ calculateSD(IMU);
+}
+
+void calculateSD(float IMU[])
+{
+ int i;
+ for(i = 0; i < n; ++i)
+ {
+ sum += IMU[i];
+ }
+
+ mean = sum/n;
+
+ for(i = 0; i < n; ++i)
+ standardDeviation += pow(IMU[i] - mean, 2);
+
+ standardDeviation = sqrt(standardDeviation / n);
+ pc.printf("SD = %f",standardDeviation) ;
+}
\ No newline at end of file