SensorController.java

/*
 * Copyright 2016 Maxst, Inc. All Rights Reserved.
 */
package com.maxst.ar;

import android.content.Context;
import android.hardware.Sensor;
import android.hardware.SensorEvent;
import android.hardware.SensorEventListener;
import android.hardware.SensorManager;

import static android.content.Context.SENSOR_SERVICE;

class SensorController implements SensorEventListener {
    private SensorManager mSensorManager;
    private Sensor mRotVectSensor;
    private float[] mRotationMatrix = new float[9];
    private float[] mTruncatedRotationVector = new float[4];

    static SensorController create(Context context) {
        SensorController instance = new SensorController(context);
        MaxstARJNI.setSensorController(instance);
        return instance;
    }

    private SensorController(Context context) {
        mSensorManager = (SensorManager) context.getSystemService(SENSOR_SERVICE);
        mRotVectSensor = mSensorManager.getDefaultSensor(Sensor.TYPE_ROTATION_VECTOR);
    }

    static void destroy() {
        MaxstARJNI.releaseSensorController();
    }

    public void start() {
        mSensorManager.registerListener(this, mRotVectSensor, SensorManager.SENSOR_DELAY_FASTEST);
    }

    public void stop() {
        mSensorManager.unregisterListener(this);
    }

    public void onSensorChanged(SensorEvent event) {
        if (event.sensor.getType() == Sensor.TYPE_ROTATION_VECTOR) {
            if (event.values.length > 4) {
                System.arraycopy(event.values, 0, mTruncatedRotationVector, 0, 4);
                SensorManager.getRotationMatrixFromVector(mRotationMatrix, mTruncatedRotationVector);
            } else {
                SensorManager.getRotationMatrixFromVector(mRotationMatrix, event.values);
            }

//          SensorManager.getRotationMatrixFromVector(mRotationMatrix, event.values);
/*
            for(int i=0; i<3; i++) {
                String line = "";
                for (int j = 0; j < 3; j++) {
                    line += mRotationMatrix[i*3+j] + ", ";
                }
                Log.i("Sensor", line);
            }
            Log.i("Sensor", "----------------------");
*/
            MaxstARJNI.setNewSensorData(mRotationMatrix);
            //SensorManager.remapCoordinateSystem(mRotationMatrix,SensorManager.AXIS_X, SensorManager.AXIS_Z, mRotationMatrix);
            //SensorManager.getOrientation(mRotationMatrix, orientationVals);
            //orientationVals[0]=(float)Math.toDegrees(orientationVals[0]);
            //orientationVals[1]=(float)Math.toDegrees(orientationVals[1]);
            //orientationVals[2]=(float)Math.toDegrees(orientationVals[2]);
        }
    }

    public void onAccuracyChanged(Sensor sensor, int accuracy) {
    }
}