com.ociweb.iot.grove.six_axis_accelerometer.AccelerometerValues Maven / Gradle / Ivy

Go to download

Show more of this group Show more artifacts with this name
Show all versions of foglight Show documentation

FogLight is a lightweight runtime that enables makers of all ages and skill levels to create highly performant apps for embedded devices like Raspberry Pi's.

The newest version!

package com.ociweb.iot.grove.six_axis_accelerometer;

import java.io.Externalizable;
import java.io.IOException;
import java.io.ObjectInput;
import java.io.ObjectOutput;

public class AccelerometerValues implements Externalizable {
    private int t = 0;
    private int mX = 0;
    private int mY = 0;
    private int mZ = 0;
    private int aX = 0;
    private int aY = 0;
    private int aZ = 0;

    public AccelerometerValues() {
    }

    public void writeExternal(ObjectOutput out) throws IOException {
        out.write(t);
        out.write(mX);
        out.write(mY);
        out.write(mZ);
        out.write(aX);
        out.write(aY);
        out.write(aZ);
    }

    public void readExternal(ObjectInput in) throws IOException, ClassNotFoundException {
        t = in.readInt();
        mX = in.readInt();
        mY = in.readInt();
        mZ = in.readInt();
        aX = in.readInt();
        aY = in.readInt();
        aZ = in.readInt();
    }

    public void magneticValues(int x, int y, int z) {
        this.mX = x;
        this.mY = y;
        this.mZ = z;
    }

    public void accelerationValues(int x,int y,int z) {
        this.aX = x;
        this.aY = y;
        this.aZ = z;
    }

    public int getMagX() {
        return mX;
    }

    public int getMagY() {
        return mY;
    }

    public int getMagZ() {
        return mZ;
    }

    public int getAccelX() {
        return aX;
    }

    public int getAccelY() {
        return aY;
    }

    public int getAccelZ() {
        return aZ;
    }

    public double getPitch() {
        return Math.asin(-aX);
    }

    public double getRoll() {
        return Math.asin(aY/Math.cos(getPitch()));
    }

    public double getHeading() {
        double heading = 180.0 * Math.atan2(mY, mX) / Math.PI;
        if (heading < 0) {
            heading += 360.0;
        }
        return heading;
    }

    public double getTiltHeading()  {
        double pitch = getPitch();
        double roll = getRoll();
        double xh = mX * Math.cos(pitch) + mZ * Math.sin(pitch);
        double yh = mX * Math.sin(roll) * Math.sin(pitch) + mY * Math.cos(roll) - mZ * Math.sin(roll) * Math.cos(pitch);
        double zh = -mX * Math.cos(roll) * Math.sin(pitch) + mY * Math.sin(roll) + mZ * Math.cos(roll) * Math.cos(pitch);
        double heading = 180 * Math.atan2(yh, xh)/Math.PI;
        if (yh < 0) {
            heading += 360.0;
        }
        return heading;
    }
}