Revision 0:9f484862187b, committed 2011-12-08

Comitter:

kvling

Date:

Thu Dec 08 05:39:11 2011 +0000

Commit message:

Changed in this revision

diff -r 000000000000 -r 9f484862187b MMA7361L.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MMA7361L.cpp	Thu Dec 08 05:39:11 2011 +0000
@@ -0,0 +1,79 @@
+#include "MMA7361L.h"
+
+MMA7361L::MMA7361L(PinName xoutPin, PinName youtPin,PinName zoutPin,
+                   PinName zeroGDetectPin, PinName gSelectPin, PinName sleepPin) :
+        xout(xoutPin), yout(youtPin), zout(zoutPin),
+        zeroGDetect(zeroGDetectPin), gSelect(gSelectPin), sleep(sleepPin) {
+    setSleep(false);
+    setScale(SCALE_1_5G);
+}
+
+float MMA7361L::getAccel() {
+    float accelX = ((xout * 3.3) - 1.65) / scale;
+    float accelY = ((yout * 3.3) - 1.65) / scale;
+    float accelZ = ((zout * 3.3) - 1.65) / scale;
+    return sqrt(accelX * accelX + accelY * accelY + accelZ * accelZ);
+}
+
+float MMA7361L::getAccelX() {
+    return ((xout * 3.3) - 1.65) / scale;
+}
+
+float MMA7361L::getAccelY() {
+    return ((yout * 3.3) - 1.65) / scale;
+}
+
+float MMA7361L::getAccelZ() {
+    return ((zout * 3.3) - 1.65) / scale;
+}
+
+float MMA7361L::getTiltX() {
+    float accelX = ((xout * 3.3) - 1.65) / scale;
+    float accelY = ((yout * 3.3) - 1.65) / scale;
+    float accelZ = ((zout * 3.3) - 1.65) / scale;
+    return asin(accelX / sqrt(accelX * accelX + accelY * accelY + accelZ * accelZ));
+}
+
+float MMA7361L::getTiltY() {
+    float accelX = ((xout * 3.3) - 1.65) / scale;
+    float accelY = ((yout * 3.3) - 1.65) / scale;
+    float accelZ = ((zout * 3.3) - 1.65) / scale;
+    return asin(accelY / sqrt(accelX * accelX + accelY * accelY + accelZ * accelZ));
+}
+
+float MMA7361L::getTiltZ() {
+    float accelX = ((xout * 3.3) - 1.65) / scale;
+    float accelY = ((yout * 3.3) - 1.65) / scale;
+    float accelZ = ((zout * 3.3) - 1.65) / scale;
+    return asin(accelZ / sqrt(accelX * accelX + accelY * accelY + accelZ * accelZ));
+}
+
+void MMA7361L::setScale(Scale scale) {
+    switch (scale) {
+        case SCALE_1_5G:
+            this->scale = 0.8;
+            gSelect = 0;
+            break;
+        case SCALE_6G:
+            this->scale = 0.206;
+            gSelect = 1;
+            break;
+    }
+}
+
+void MMA7361L::setSleep(bool on) {
+    sleep = !on;
+}
+
+bool MMA7361L::zeroGDetected() {
+    return zeroGDetect;
+}
+
+void MMA7361L::setZeroGDetectListener(void (*func)(void)) {
+    zeroGDetect.rise(func);
+}
+
+template<typename T> void MMA7361L::setZeroGDetectListener(T* t, void (T::*func)(void)) {
+    zeroG.rise(t, func);
+}
+

diff -r 000000000000 -r 9f484862187b MMA7361L.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MMA7361L.h	Thu Dec 08 05:39:11 2011 +0000
@@ -0,0 +1,28 @@
+#include "mbed.h"
+
+class MMA7361L {
+public:
+    MMA7361L(PinName xoutPin, PinName youtPin,PinName zoutPin,
+             PinName zeroGDetectPin, PinName gSelectPin, PinName sleepPin);
+
+    enum Scale {SCALE_1_5G, SCALE_6G};
+    float getAccel();
+    float getAccelX();
+    float getAccelY();
+    float getAccelZ();
+    float getTiltX();
+    float getTiltY();
+    float getTiltZ();
+    void setScale(Scale scale);
+    void setSleep(bool on);
+    bool zeroGDetected();
+    void setZeroGDetectListener(void (*func)(void));
+    template<typename T> void setZeroGDetectListener(T* t, void (T::*func)(void));
+
+private:
+    AnalogIn xout, yout, zout;
+    InterruptIn zeroGDetect;
+    DigitalOut gSelect;
+    DigitalOut sleep;
+    float scale;
+};