Android实现计步传感器功能

public class MainActivity extends AppCompatActivity implements StepSensorBase.StepCallBack{
  .........
  @Override
  public void Step(int stepNum) {
    // 计步回调
    stepText.setText("步数:" + stepNum);
  }

  @Override
  protected void onCreate(Bundle savedInstanceState) {
    super.onCreate(savedInstanceState);   
    setContentView(R.layout.activity_main);
    stepText = (TextView) findViewById(R.id.step_text);

    // 开启计步监听, 分为加速度传感器、或计步传感器
    stepSensor = new StepSensorPedometer(this, this);
    if (!stepSensor.registerStep()) {
      Toast.makeText(this, "计步传传感器不可用！", Toast.LENGTH_SHORT).show();
      stepSensor = new StepSensorAcceleration(this, this);
      if (!stepSensor.registerStep()) {
        Toast.makeText(this, "加速度传感器不可用！", Toast.LENGTH_SHORT).show();
      }
    }
  }
  .......
 }

 /**
 * 计步传感器抽象类，子类分为加速度传感器、或计步传感器
 */
public abstract class StepSensorBase implements SensorEventListener {
  private Context context;
  protected StepCallBack stepCallBack;
  protected SensorManager sensorManager;
  protected static int CURRENT_SETP = 0;
  protected boolean isAvailable = false;

  public StepSensorBase(Context context, StepCallBack stepCallBack) {
    this.context = context;
    this.stepCallBack = stepCallBack;
  }

  public interface StepCallBack {
    /**
     * 计步回调
     */
    void Step(int stepNum);
  }

  /**
   * 开启计步
   */
  public boolean registerStep() {
    if (sensorManager != null) {
      sensorManager.unregisterListener(this);
      sensorManager = null;
    }
    sensorManager = SensorUtil.getInstance().getSensorManager(context);
    registerStepListener();
    return isAvailable;
  }

  /**
   * 注册计步监听器
   */
  protected abstract void registerStepListener();

  /**
   * 注销计步监听器
   */
  public abstract void unregisterStep();
}

/**
 * 计步传感器
 */
public class StepSensorPedometer extends StepSensorBase {
  private final String TAG = "StepSensorPedometer";
  private int lastStep = -1;
  private int liveStep = 0;
  private int increment = 0;
  private int sensorMode = 0; // 计步传感器类型

  public StepSensorPedometer(Context context, StepCallBack stepCallBack) {
    super(context, stepCallBack);
  }

  @Override
  protected void registerStepListener() {
    Sensor detectorSensor = sensorManager.getDefaultSensor(Sensor.TYPE_STEP_DETECTOR);
    Sensor countSensor = sensorManager.getDefaultSensor(Sensor.TYPE_STEP_COUNTER);
    if (sensorManager.registerListener(this, detectorSensor, SensorManager.SENSOR_DELAY_GAME)) {
      isAvailable = true;
      sensorMode = 0;
      Log.i(TAG, "计步传感器Detector可用！");
    } else if (sensorManager.registerListener(this, countSensor, SensorManager.SENSOR_DELAY_GAME)) {
      isAvailable = true;
      sensorMode = 1;
      Log.i(TAG, "计步传感器Counter可用！");
    } else {
      isAvailable = false;
      Log.i(TAG, "计步传感器不可用！");
    }
  }

  @Override
  public void unregisterStep() {
    sensorManager.unregisterListener(this);
  }

  @Override
  public void onSensorChanged(SensorEvent event) {
    liveStep = (int) event.values[0];
    if (sensorMode == 0) {
      Log.i(TAG, "Detector步数："+liveStep);
      StepSensorBase.CURRENT_SETP += liveStep;
    } else if (sensorMode == 1) {
      Log.i(TAG, "Counter步数："+liveStep);
      StepSensorBase.CURRENT_SETP = liveStep;
    }
    stepCallBack.Step(StepSensorBase.CURRENT_SETP);
  }

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

/**
 * 加速度传感器
 */
public class StepSensorAcceleration extends StepSensorBase {
  private final String TAG = "StepSensorAcceleration";
  //存放三轴数据
  final int valueNum = 5;
  //用于存放计算阈值的波峰波谷差值
  float[] tempValue = new float[valueNum];
  int tempCount = 0;
  //是否上升的标志位
  boolean isDirectionUp = false;
  //持续上升次数
  int continueUpCount = 0;
  //上一点的持续上升的次数，为了记录波峰的上升次数
  int continueUpFormerCount = 0;
  //上一点的状态，上升还是下降
  boolean lastStatus = false;
  //波峰值
  float peakOfWave = 0;
  //波谷值
  float valleyOfWave = 0;
  //此次波峰的时间
  long timeOfThisPeak = 0;
  //上次波峰的时间
  long timeOfLastPeak = 0;
  //当前的时间
  long timeOfNow = 0;
  //当前传感器的值
  float gravityNew = 0;
  //上次传感器的值
  float gravityOld = 0;
  //动态阈值需要动态的数据，这个值用于这些动态数据的阈值
  final float initialValue = (float) 1.7;
  //初始阈值
  float ThreadValue = (float) 2.0;

  //初始范围
  float minValue = 11f;
  float maxValue = 19.6f;

  /**
   * 0-准备计时  1-计时中 2-正常计步中
   */
  private int CountTimeState = 0;
  public static int TEMP_STEP = 0;
  private int lastStep = -1;
  //用x、y、z轴三个维度算出的平均值
  public static float average = 0;
  private Timer timer;
  // 倒计时3.5秒，3.5秒内不会显示计步，用于屏蔽细微波动
  private long duration = 3500;
  private TimeCount time;

  public StepSensorAcceleration(Context context, StepCallBack stepCallBack) {
    super(context, stepCallBack);
  }

  @Override
  protected void registerStepListener() {
    // 注册加速度传感器
    isAvailable = sensorManager.registerListener(this, sensorManager.getDefaultSensor(Sensor.TYPE_ACCELEROMETER),
        SensorManager.SENSOR_DELAY_GAME);
    if (isAvailable) {
      Log.i(TAG, "加速度传感器可用！");
    } else {
      Log.i(TAG, "加速度传感器不可用！");
    }
  }

  @Override
  public void unregisterStep() {
    sensorManager.unregisterListener(this);
  }

  public void onAccuracyChanged(Sensor arg0, int arg1) {
  }

  public void onSensorChanged(SensorEvent event) {
    Sensor sensor = event.sensor;
    synchronized (this) {
      if (sensor.getType() == Sensor.TYPE_ACCELEROMETER) {
        calc_step(event);
      }
    }
  }

  synchronized private void calc_step(SensorEvent event) {
    average = (float) Math.sqrt(Math.pow(event.values[0], 2)
        + Math.pow(event.values[1], 2) + Math.pow(event.values[2], 2));
    detectorNewStep(average);
  }

  /*
   * 检测步子，并开始计步
   * 1.传入sersor中的数据
   * 2.如果检测到了波峰，并且符合时间差以及阈值的条件，则判定为1步
   * 3.符合时间差条件，波峰波谷差值大于initialValue，则将该差值纳入阈值的计算中
   * */
  public void detectorNewStep(float values) {
    if (gravityOld == 0) {
      gravityOld = values;
    } else {
      if (DetectorPeak(values, gravityOld)) {
        timeOfLastPeak = timeOfThisPeak;
        timeOfNow = System.currentTimeMillis();

        if (timeOfNow - timeOfLastPeak >= 200
            && (peakOfWave - valleyOfWave >= ThreadValue) && (timeOfNow - timeOfLastPeak) <= 2000) {
          timeOfThisPeak = timeOfNow;
          //更新界面的处理，不涉及到算法
          preStep();
        }
        if (timeOfNow - timeOfLastPeak >= 200
            && (peakOfWave - valleyOfWave >= initialValue)) {
          timeOfThisPeak = timeOfNow;
          ThreadValue = Peak_Valley_Thread(peakOfWave - valleyOfWave);
        }
      }
    }
    gravityOld = values;
  }

  private void preStep() {
//    if (CountTimeState == 0) {
//      // 开启计时器
//      time = new TimeCount(duration, 700);
//      time.start();
//      CountTimeState = 1;
//      Log.v(TAG, "开启计时器");
//    } else if (CountTimeState == 1) {
//      TEMP_STEP++;
//      Log.v(TAG, "计步中 TEMP_STEP:" + TEMP_STEP);
//    } else if (CountTimeState == 2) {
    StepSensorBase.CURRENT_SETP++;
//      if (stepCallBack != null) {
    stepCallBack.Step(StepSensorBase.CURRENT_SETP);
//      }
//    }

  }


  /*
   * 检测波峰
   * 以下四个条件判断为波峰：
   * 1.目前点为下降的趋势：isDirectionUp为false
   * 2.之前的点为上升的趋势：lastStatus为true
   * 3.到波峰为止，持续上升大于等于2次
   * 4.波峰值大于1.2g,小于2g
   * 记录波谷值
   * 1.观察波形图，可以发现在出现步子的地方，波谷的下一个就是波峰，有比较明显的特征以及差值
   * 2.所以要记录每次的波谷值，为了和下次的波峰做对比
   * */
  public boolean DetectorPeak(float newValue, float oldValue) {
    lastStatus = isDirectionUp;
    if (newValue >= oldValue) {
      isDirectionUp = true;
      continueUpCount++;
    } else {
      continueUpFormerCount = continueUpCount;
      continueUpCount = 0;
      isDirectionUp = false;
    }

//    Log.v(TAG, "oldValue:" + oldValue);
    if (!isDirectionUp && lastStatus
        && (continueUpFormerCount >= 2 && (oldValue >= minValue && oldValue < maxValue))) {
      peakOfWave = oldValue;
      return true;
    } else if (!lastStatus && isDirectionUp) {
      valleyOfWave = oldValue;
      return false;
    } else {
      return false;
    }
  }

  /*
   * 阈值的计算
   * 1.通过波峰波谷的差值计算阈值
   * 2.记录4个值，存入tempValue[]数组中
   * 3.在将数组传入函数averageValue中计算阈值
   * */
  public float Peak_Valley_Thread(float value) {
    float tempThread = ThreadValue;
    if (tempCount < valueNum) {
      tempValue[tempCount] = value;
      tempCount++;
    } else {
      tempThread = averageValue(tempValue, valueNum);
      for (int i = 1; i < valueNum; i++) {
        tempValue[i - 1] = tempValue[i];
      }
      tempValue[valueNum - 1] = value;
    }
    return tempThread;

  }

  /*
   * 梯度化阈值
   * 1.计算数组的均值
   * 2.通过均值将阈值梯度化在一个范围里
   * */
  public float averageValue(float value[], int n) {
    float ave = 0;
    for (int i = 0; i < n; i++) {
      ave += value[i];
    }
    ave = ave / valueNum;
    if (ave >= 8) {
//      Log.v(TAG, "超过8");
      ave = (float) 4.3;
    } else if (ave >= 7 && ave < 8) {
//      Log.v(TAG, "7-8");
      ave = (float) 3.3;
    } else if (ave >= 4 && ave < 7) {
//      Log.v(TAG, "4-7");
      ave = (float) 2.3;
    } else if (ave >= 3 && ave < 4) {
//      Log.v(TAG, "3-4");
      ave = (float) 2.0;
    } else {
//      Log.v(TAG, "else");
      ave = (float) 1.7;
    }
    return ave;
  }

  class TimeCount extends CountDownTimer {
    public TimeCount(long millisInFuture, long countDownInterval) {
      super(millisInFuture, countDownInterval);
    }

    @Override
    public void onFinish() {
      // 如果计时器正常结束，则开始计步
      time.cancel();
      StepSensorBase.CURRENT_SETP += TEMP_STEP;
      lastStep = -1;
      Log.v(TAG, "计时正常结束");

      timer = new Timer(true);
      TimerTask task = new TimerTask() {
        public void run() {
          if (lastStep == StepSensorBase.CURRENT_SETP) {
            timer.cancel();
            CountTimeState = 0;
            lastStep = -1;
            TEMP_STEP = 0;
            Log.v(TAG, "停止计步：" + StepSensorBase.CURRENT_SETP);
          } else {
            lastStep = StepSensorBase.CURRENT_SETP;
          }
        }
      };
      timer.schedule(task, 0, 2000);
      CountTimeState = 2;
    }

    @Override
    public void onTick(long millisUntilFinished) {
      if (lastStep == TEMP_STEP) {
        Log.v(TAG, "onTick 计时停止:" + TEMP_STEP);
        time.cancel();
        CountTimeState = 0;
        lastStep = -1;
        TEMP_STEP = 0;
      } else {
        lastStep = TEMP_STEP;
      }
    }
  }
}