MPU6050检测晃动

SLin

/**
*  @brief      Set shake rejection threshold.
*  If the DMP detects a gyro sample larger than @e thresh, taps are rejected.
*  @param[in]  sf      Gyro scale factor.
*  @param[in]  thresh  Gyro threshold in dps.
*  @return     0 if successful.
*/
int dmp_set_shake_reject_thresh(long sf, unsigned short thresh)
{
    unsigned char tmp[4];
    long thresh_scaled = sf / 1000 * thresh;
    tmp[0] = (unsigned char)(((long)thresh_scaled >> 24) & 0xFF);
    tmp[1] = (unsigned char)(((long)thresh_scaled >> 16) & 0xFF);
    tmp[2] = (unsigned char)(((long)thresh_scaled >> 8) & 0xFF);
    tmp[3] = (unsigned char)((long)thresh_scaled & 0xFF);
    return mpu_write_mem(D_1_92, 4, tmp);
}

/**
*  @brief      Set shake rejection time.
*  Sets the length of time that the gyro must be outside of the threshold set
*  by @e gyro_set_shake_reject_thresh before taps are rejected. A mandatory
*  60 ms is added to this parameter.
*  @param[in]  time    Time in milliseconds.
*  @return     0 if successful.
*/
int dmp_set_shake_reject_time(unsigned short time)
{
    unsigned char tmp[2];

    time /= (1000 / DMP_SAMPLE_RATE);
    tmp[0] = time >> 8;
    tmp[1] = time & 0xFF;
    return mpu_write_mem(D_1_90,2,tmp);
}




这是例程上的，不知道可不可以用来检测晃动，还有这个程序的功能是什么

SLin

怎么没人？

SLin

看来要沉了

正点原子

帮顶