Yiu Fai Kwok / FXOS8700CQ

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependents:   el17yfk el17yfk

Diff: FXOS8700CQ.cpp

Revision:
3:eedcae2bd4aa
Parent:
0:f66eda6a492a
Child:
4:5a6ef0d027c4
--- a/FXOS8700CQ.cpp	Mon Feb 06 08:41:24 2017 +0000
+++ b/FXOS8700CQ.cpp	Wed Apr 17 17:53:33 2019 +0000
@@ -8,6 +8,7 @@
 */ 
 
 #include "FXOS8700CQ.h"
+#include <cmath>
 
 // constructor is called when the object is created - use it to set pins and frequency
 FXOS8700CQ::FXOS8700CQ(PinName sda, PinName scl)
@@ -159,4 +160,20 @@
     if (nack)
         error("No acknowledgement received!");  // if we don't receive acknowledgement, send error message
 
+}
+
+float FXOS8700CQ::get_pitch_angle()
+{
+    Data values = get_values();
+    float pitch_angle = atan2(-values.ax,sqrt(values.ay*values.ay + values.az*values.az))*180.0/3.1416;
+    
+    return pitch_angle;
+}
+
+float FXOS8700CQ::get_roll_angle()
+{
+    Data values = get_values();
+    float roll_angle = atan2(values.ay,values.az)*180.0/3.1416;
+    
+    return roll_angle;
 }
\ No newline at end of file