mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-27 01:23:34 +08:00
delete unused IOCTL GYROIOCGSAMPLERATE
This commit is contained in:
committed by
Lorenz Meier
parent
0d67050089
commit
60c14fe8f1
@@ -76,9 +76,6 @@ struct gyro_calibration_s {
|
|||||||
|
|
||||||
#define GYRO_SAMPLERATE_DEFAULT 1000003 /**< default sample rate */
|
#define GYRO_SAMPLERATE_DEFAULT 1000003 /**< default sample rate */
|
||||||
|
|
||||||
/** return the gyro internal sample rate in Hz */
|
|
||||||
#define GYROIOCGSAMPLERATE _GYROIOC(1)
|
|
||||||
|
|
||||||
/** set the gyro scaling constants to (arg) */
|
/** set the gyro scaling constants to (arg) */
|
||||||
#define GYROIOCSSCALE _GYROIOC(4)
|
#define GYROIOCSSCALE _GYROIOC(4)
|
||||||
|
|
||||||
|
|||||||
@@ -1117,9 +1117,6 @@ ADIS16448::gyro_ioctl(struct file *filp, int cmd, unsigned long arg)
|
|||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
case GYROIOCGSAMPLERATE:
|
|
||||||
return _sample_rate;
|
|
||||||
|
|
||||||
case GYROIOCSSAMPLERATE:
|
case GYROIOCSSAMPLERATE:
|
||||||
_set_sample_rate(arg);
|
_set_sample_rate(arg);
|
||||||
return OK;
|
return OK;
|
||||||
|
|||||||
@@ -438,9 +438,6 @@ ADIS16477::gyro_ioctl(struct file *filp, int cmd, unsigned long arg)
|
|||||||
case SENSORIOCRESET:
|
case SENSORIOCRESET:
|
||||||
return ioctl(filp, cmd, arg);
|
return ioctl(filp, cmd, arg);
|
||||||
|
|
||||||
case GYROIOCGSAMPLERATE:
|
|
||||||
return _sample_rate;
|
|
||||||
|
|
||||||
case GYROIOCSSAMPLERATE:
|
case GYROIOCSSAMPLERATE:
|
||||||
_set_sample_rate(arg);
|
_set_sample_rate(arg);
|
||||||
return OK;
|
return OK;
|
||||||
|
|||||||
@@ -399,9 +399,6 @@ BMI055_gyro::ioctl(struct file *filp, int cmd, unsigned long arg)
|
|||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
case GYROIOCGSAMPLERATE:
|
|
||||||
return _gyro_sample_rate;
|
|
||||||
|
|
||||||
case GYROIOCSSAMPLERATE:
|
case GYROIOCSSAMPLERATE:
|
||||||
return gyro_set_sample_rate(arg);
|
return gyro_set_sample_rate(arg);
|
||||||
|
|
||||||
|
|||||||
@@ -700,9 +700,6 @@ BMI160::gyro_ioctl(struct file *filp, int cmd, unsigned long arg)
|
|||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
case GYROIOCGSAMPLERATE:
|
|
||||||
return _gyro_sample_rate;
|
|
||||||
|
|
||||||
case GYROIOCSSAMPLERATE:
|
case GYROIOCSSAMPLERATE:
|
||||||
return gyro_set_sample_rate(arg);
|
return gyro_set_sample_rate(arg);
|
||||||
|
|
||||||
|
|||||||
@@ -737,9 +737,6 @@ FXAS21002C::ioctl(struct file *filp, int cmd, unsigned long arg)
|
|||||||
case GYROIOCSSAMPLERATE:
|
case GYROIOCSSAMPLERATE:
|
||||||
return set_samplerate(arg);
|
return set_samplerate(arg);
|
||||||
|
|
||||||
case GYROIOCGSAMPLERATE:
|
|
||||||
return _current_rate;
|
|
||||||
|
|
||||||
case GYROIOCSSCALE:
|
case GYROIOCSSCALE:
|
||||||
/* copy scale in */
|
/* copy scale in */
|
||||||
memcpy(&_gyro_scale, (struct gyro_calibration_s *) arg, sizeof(_gyro_scale));
|
memcpy(&_gyro_scale, (struct gyro_calibration_s *) arg, sizeof(_gyro_scale));
|
||||||
|
|||||||
@@ -661,9 +661,6 @@ L3GD20::ioctl(struct file *filp, int cmd, unsigned long arg)
|
|||||||
case GYROIOCSSAMPLERATE:
|
case GYROIOCSSAMPLERATE:
|
||||||
return set_samplerate(arg);
|
return set_samplerate(arg);
|
||||||
|
|
||||||
case GYROIOCGSAMPLERATE:
|
|
||||||
return _current_rate;
|
|
||||||
|
|
||||||
case GYROIOCSSCALE:
|
case GYROIOCSSCALE:
|
||||||
/* copy scale in */
|
/* copy scale in */
|
||||||
memcpy(&_gyro_scale, (struct gyro_calibration_s *) arg, sizeof(_gyro_scale));
|
memcpy(&_gyro_scale, (struct gyro_calibration_s *) arg, sizeof(_gyro_scale));
|
||||||
|
|||||||
@@ -1409,9 +1409,6 @@ MPU6000::gyro_ioctl(struct file *filp, int cmd, unsigned long arg)
|
|||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
case GYROIOCGSAMPLERATE:
|
|
||||||
return _sample_rate;
|
|
||||||
|
|
||||||
case GYROIOCSSAMPLERATE:
|
case GYROIOCSSAMPLERATE:
|
||||||
_set_sample_rate(arg);
|
_set_sample_rate(arg);
|
||||||
return OK;
|
return OK;
|
||||||
|
|||||||
@@ -875,9 +875,6 @@ MPU9250::gyro_ioctl(struct file *filp, int cmd, unsigned long arg)
|
|||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
case GYROIOCGSAMPLERATE:
|
|
||||||
return _sample_rate;
|
|
||||||
|
|
||||||
case GYROIOCSSAMPLERATE:
|
case GYROIOCSSAMPLERATE:
|
||||||
_set_sample_rate(arg);
|
_set_sample_rate(arg);
|
||||||
return OK;
|
return OK;
|
||||||
|
|||||||
@@ -741,9 +741,6 @@ GYROSIM::gyro_ioctl(unsigned long cmd, unsigned long arg)
|
|||||||
return OK;
|
return OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
case GYROIOCGSAMPLERATE:
|
|
||||||
return 1e6 / m_sample_interval_usecs;
|
|
||||||
|
|
||||||
case GYROIOCSSAMPLERATE:
|
case GYROIOCSSAMPLERATE:
|
||||||
_set_sample_rate(arg);
|
_set_sample_rate(arg);
|
||||||
return OK;
|
return OK;
|
||||||
|
|||||||
@@ -203,15 +203,14 @@ do_gyro(int argc, char *argv[])
|
|||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
int srate = ioctl(fd, GYROIOCGSAMPLERATE, 0);
|
|
||||||
int prate = ioctl(fd, SENSORIOCGPOLLRATE, 0);
|
int prate = ioctl(fd, SENSORIOCGPOLLRATE, 0);
|
||||||
int id = ioctl(fd, DEVIOCGDEVICEID, 0);
|
int id = ioctl(fd, DEVIOCGDEVICEID, 0);
|
||||||
int32_t calibration_id = 0;
|
int32_t calibration_id = 0;
|
||||||
|
|
||||||
param_get(param_find("CAL_GYRO0_ID"), &(calibration_id));
|
param_get(param_find("CAL_GYRO0_ID"), &(calibration_id));
|
||||||
|
|
||||||
PX4_INFO("gyro: \n\tdevice id:\t0x%X\t(calibration is for device id 0x%X)\n\tsample rate:\t%d Hz\n\tread rate:\t%d Hz",
|
PX4_INFO("gyro: \n\tdevice id:\t0x%X\t(calibration is for device id 0x%X)\n\tread rate:\t%d Hz",
|
||||||
id, calibration_id, srate, prate);
|
id, calibration_id, prate);
|
||||||
|
|
||||||
close(fd);
|
close(fd);
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user