|
|
@ -1421,13 +1421,6 @@ MPU6000::gyro_ioctl(struct file *filp, int cmd, unsigned long arg) |
|
|
|
memcpy(&_gyro_scale, (struct gyro_calibration_s *) arg, sizeof(_gyro_scale)); |
|
|
|
memcpy(&_gyro_scale, (struct gyro_calibration_s *) arg, sizeof(_gyro_scale)); |
|
|
|
return OK; |
|
|
|
return OK; |
|
|
|
|
|
|
|
|
|
|
|
case GYROIOCSRANGE: |
|
|
|
|
|
|
|
/* XXX not implemented */ |
|
|
|
|
|
|
|
// XXX change these two values on set:
|
|
|
|
|
|
|
|
// _gyro_range_scale = xx
|
|
|
|
|
|
|
|
// _gyro_range_rad_s = xx
|
|
|
|
|
|
|
|
return -EINVAL; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
case GYROIOCGRANGE: |
|
|
|
case GYROIOCGRANGE: |
|
|
|
return (unsigned long)(_gyro_range_rad_s * 180.0f / M_PI_F + 0.5f); |
|
|
|
return (unsigned long)(_gyro_range_rad_s * 180.0f / M_PI_F + 0.5f); |
|
|
|
|
|
|
|
|
|
|
|