集成 Android 加速度计以查找速度和位置

Integrating Android Accelerometer to Find Velocity and Position

我正在尝试使用 Android 设备 (Sensor.TYPE_LINEAR_ACCELERATION) 上的加速度计计算位移。这是我的 OnSensorChanged() 方法:

public void onSensorChanged(SensorEvent event) {
    accelX = event.values[0];
    accelY = event.values[1];
    accelZ = event.values[2];

    long currentTime = System.currentTimeMillis() / 1000;

    if(prevTime == 0) prevTime = currentTime;

    long interval = currentTime - prevTime;
    prevTime = currentTime;     

    velX += accelX * interval;
    velY += accelY * interval;
    velZ += accelZ * interval;

    distX += prevVelX + velX * interval;
    distY += prevVelY + velY * interval;
    distZ += prevVelZ + velZ * interval;

    prevAccelX = accelX;        
    prevAccelY = accelY;        
    prevAccelZ = accelZ;

    prevVelX = velX;
    prevVelY = velY;
    prevVelZ = velZ;
}

然而,速度在任何类型的移动后都不会 return 为 0。除非非常突然,否则减速几乎没有影响。这会导致一些非常不准确的距离值。

加速度计也很吵,所以我加了这个:

accelX = (accelX * accelKFactor) + prevAccelX * (1 - accelKFactor);
accelY = (accelY * accelKFactor) + prevAccelY * (1 - accelKFactor);
accelY = (accelX * accelKFactor) + prevAccelY * (1 - accelKFactor);

其中 accelKFactor = .01

我是不是遗漏了什么明显的东西?

我的最终目标只是能够判断设备是否移动超过 ~10 英尺,但现在,我的数据几乎没有用。

编辑:

我发现了部分问题。 currentTime 很长,但我将以毫秒为单位的系统时间除以 1000 得到秒数。所以速度只能真正每 1 秒更新一次。将 currentTime 更改为 double 有帮助,但不能完全解决问题。

SensorEvent 有一个时间戳字段,它是以纳秒为单位的时间。使用它代替 System.currentTimeMillis()。这是文档中的示例:

private static final float NS2S = 1.0f / 1000000000.0f;
 private float timestamp;

 public void onSensorChanged(SensorEvent event) {
      // This timestep's delta rotation to be multiplied by the current rotation
      // after computing it from the gyro sample data.
      if (timestamp != 0) {
          final float dT = (event.timestamp - timestamp) * NS2S;

以这种方式跟踪位移对初始条件极其敏感,因此这应该有所帮助。

此外,使用 Location.getSpeed() 可能会有更好的运气。如果您无法获得信号,请考虑仅将加速度计用作备用。

请检查以下代码

public class MainActivity extends Activity implements SensorEventListener {
    private SensorManager sensorManager;
    float appliedAcceleration = 0;
    float currentAcceleration = 0;
    float velocity = 0;
    Date lastUpdatedate;
    double calibration = Double.NaN;

    @Override
    public void onCreate(Bundle savedInstanceState) {
        requestWindowFeature(Window.FEATURE_NO_TITLE);
        getWindow().setFlags(WindowManager.LayoutParams.FLAG_FULLSCREEN,
                WindowManager.LayoutParams.FLAG_FULLSCREEN);

        super.onCreate(savedInstanceState);
        setContentView(R.layout.activity_main2);
        lastUpdatedate = new Date(System.currentTimeMillis());
        sensorManager = (SensorManager) getSystemService(SENSOR_SERVICE);
    }

    @Override
    public void onSensorChanged(SensorEvent event) {
        double x = event.values[0];
        double y = event.values[1];
        double z = event.values[2];
        double a = Math.sqrt(Math.pow(x, 2) + Math.pow(y, 2) + Math.pow(z, 2));
        if (calibration == Double.NaN)
            calibration = a;
        else {
            Date timeNow = new Date(System.currentTimeMillis());
            long timeDelta = timeNow.getTime()-lastUpdatedate.getTime();
            lastUpdatedate.setTime(timeNow.getTime());
            float deltaVelocity = appliedAcceleration * (timeDelta/1000);
            appliedAcceleration = currentAcceleration;
            velocity += deltaVelocity;
            final double mph = (Math.round(100*velocity / 1.6 * 3.6))/100;
            Log.i("SensorTestActivity","SPEEDDDDD=== "+mph+"     "+velocity);
            currentAcceleration = (float)a;
        }
    }

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

    }

    @Override
    protected void onStart() {
        super.onStart();
        sensorManager.registerListener(this,
                sensorManager.getDefaultSensor(Sensor.TYPE_ACCELEROMETER),
                SensorManager.SENSOR_DELAY_NORMAL);
    }

    @Override
    protected void onStop() {
        super.onStop();
        sensorManager.unregisterListener(this);
    }
}