泛在无线网络团队蓝牙室内定位项目安卓客户端.zip

package com.mirraico.bluetoothindoorlocation.pedometer; import android.hardware.Sensor; import android.hardware.SensorEvent; import android.hardware.SensorEventListener; import android.hardware.SensorManager; import android.os.Bundle; import android.os.Message; import android.util.Log; import com.mirraico.bluetoothindoorlocation.map.MainActivity; import org.json.JSONArray; import org.json.JSONException; import org.json.JSONObject; public class SensorChangeListener implements SensorEventListener { private static String TAG = SensorChangeListener.class.getSimpleName(); /* 以下部分用于计步 */ //存放三轴加速度数据 private float[] acceleratorValues = new float[3]; //是否上升 private boolean isUp = false; //上一点的状态，是否上升 private boolean lastIsUp = false; //持续上升次数 private int continueUpCount = 0; //上一点的持续上升次数，为了记录波峰的上升次数(在下降时使用) private int lastContinueUpCount = 0; //波峰值 private float peakValue = 0; //波谷值 private float valleyValue = 0; //此次波峰的时间 private long timeOfThisPeak = 0; //上次波峰的时间 private long timeOfLastPeak = 0; //当前的时间 private long timeOfNow = 0; //当前传感器的值 private float sensorValue = 0; //上次传感器的值 private float lastSensorValue = 0; //峰谷阀值，该值动态计算，大于该值才记为一步，初始2.0 private float thresholdValue = (float) 2.0; //能够纳入峰谷阀值计算的阀值，大于该值的峰谷差值才参与上述峰谷阀值的计算 private final float judgeValue = (float) 1.3; //用于存放计算峰谷阀值的峰谷差值 private final int arrayNum = 4; private float[] thresholdArray = new float[arrayNum]; private int arrayCount = 0; //步数累计，用于过滤无意义抖动 private int stepCount = 0; //已经在行走的标记 private boolean stepFlag = false; /* 以下部分用于sensor采集并处理加速度 */ //存放三轴地磁强度数据 private float[] magneticValues = new float[3]; //存放三轴线性加速度数据 private float[] linearAcceleratorValues = new float[3]; //存放待发送的数据，从静止到走动START_STEP次一发，走动中2次一发 private final static int START_STEP = 6; private PedometerData[] pedometerDatas = new PedometerData[START_STEP]; private int sendCnt = 0; //回调接口 private StepListener stepListener; //构造函数，传递回调接口进来 public SensorChangeListener(StepListener stepListener) { this.stepListener = stepListener; } /* * 原理 * 1.波峰波谷的判定(连续上升、上升阀值等) * 2.峰谷差值需要大于峰谷阀值 * 3.波峰时间差需要大于某个值 * 4.峰谷差值是动态改变的 * * * 可以调节的参数 * 1.波峰判定中的连续上升次数lastContinueUpCount 2 * 2.波峰判定中，没达到连续上升次数但可能是一次很大的上升值，判定该上升值的阀值 20 * 3.波峰时间差判定 250ms * 4.计步累计启动步数 5 * 5.参与峰谷阀值计算的阀值judgeValue 1.3 * 6.重新计算峰谷阀值的峰谷差值累计个数arrayNum 4 * 7.梯度化阀值中的梯度值和阀值设定averageValue() * 多判断了就尝试提高阀值，少判断了就尝试降低阀值 测试走路、跑步、手机位置等多种场景，设定好不同场景的梯度，再设定阀值 */ /* * 注册服务后一直会调用这个函数(sensor是一直会变化的) * 如果是TYPE_ACCELEROMETER数据先对三轴数据进行平方和开根号的处理 * 然后调用DetectorNewStep检测步子 * 检测到步子后会利用其它数据一起计算一些信息，并回调onSend()函数 * 如果是其它数据仅做收集 */ @Override public void onSensorChanged(SensorEvent event) { switch (event.sensor.getType()) { case Sensor.TYPE_ACCELEROMETER: acceleratorValues = event.values.clone(); sensorValue = (float) Math.sqrt(acceleratorValues[0] * acceleratorValues[0] + acceleratorValues[1] * acceleratorValues[1] + acceleratorValues[2] * acceleratorValues[2]); detectNewStep(sensorValue); break; case Sensor.TYPE_MAGNETIC_FIELD: magneticValues = event.values.clone(); break; case Sensor.TYPE_LINEAR_ACCELERATION: linearAcceleratorValues = event.values.clone(); break; default: break; } //计算航向角通知主界面 float[] R = new float[9]; float[] values = new float[3]; SensorManager.getRotationMatrix(R, null, acceleratorValues, magneticValues); SensorManager.getOrientation(R, values); Message sendMsg = Message.obtain(); Bundle sendData = new Bundle(); sendData.putInt("type", MainActivity.TYPE_ANGLE); sendData.putFloat("angle", new Double(Math.toDegrees(values[0])).floatValue()); sendMsg.setData(sendData); MainActivity.handler.sendMessage(sendMsg); } /* * 检测步子，并开始计步 * 1.传入sersor中的数据 * 2.如果检测到了波峰，并且符合时间差以及阈值的条件，则判定为1步 * 3.符合时间差条件，波峰波谷差值大于initialValue，则将该差值纳入阈值的计算中 */ public void detectNewStep(float sensorValue) { if (lastSensorValue == 0) { //第一次值 lastSensorValue = sensorValue; } else { if (detectPeak(sensorValue, lastSensorValue)) { //如果检测到了波峰 timeOfLastPeak = timeOfThisPeak; timeOfNow = System.currentTimeMillis(); if (timeOfNow - timeOfLastPeak >= 250 //过滤短时间的连续波峰 && (peakValue - valleyValue >= thresholdValue) //峰谷阀值判定，峰谷差值大于该阀值才有效 ) { timeOfThisPeak = timeOfNow; //超过3步开始计步，防止无意义抖动，前3步会在第3步的时候一起显示，同时3步一起发送 if(detectValidStep()) { pedometerDatas[sendCnt] = new PedometerData(sendCnt + 1, timeOfNow - timeOfLastPeak); pedometerDatas[sendCnt].pushSensorData(generateSensorData()); sendCnt += 1; Log.e(TAG, "STEP COUNT: " + sendCnt); } else { sendCnt = 0; stepFlag = false; Log.e(TAG, "STEP COUNT: " + sendCnt); } //2次(行动中)或START_STEP次(静止)调用回调函数 if ((stepFlag && sendCnt == 2) || (!stepFlag && sendCnt == START_STEP)) { stepFlag = true; JSONArray pedometerArray = new JSONArray(); try { for(int i = 0; i < sendCnt; i++) { JSONObject jsonObject; jsonObject = new JSONObject(); jsonObject.put("stepNo", pedometerDatas[i].getStepNo()); jsonObject.put("timeDiff", pedometerDatas[i].getTimeDiff()); JSONArray sensorArray = new JSONArray(); SensorData[] sensorDatas = pedometerDatas[i].getSensorArray(); for(int j = 0; j < sensorDatas.length; j++) {