yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-21 01:12:11 +00:00
Code Issues Packages Projects Releases Wiki Activity

drivers/adc: start WQ cycle on init

Browse Source
This commit is contained in:
Daniel Agar
2019-12-30 14:57:25 -05:00
committed by Lorenz Meier
parent ef12e63af2
commit e48b8b1abe
1 changed files with 21 additions and 40 deletions
Download Patch File Download Diff File Expand all files Collapse all files

61
src/drivers/adc/adc.cpp
View File

@@ -64,19 +64,14 @@ class ADC : public cdev::CDev, public px4::ScheduledWorkItem
{
public:
ADC(uint32_t base_address, uint32_t channels);
~ADC();
~ADC() override;
virtual int init();
int init() override;
virtual int ioctl(file *filp, int cmd, unsigned long arg);
virtual ssize_t read(file *filp, char *buffer, size_t len);
protected:
virtual int open_first(struct file *filp);
virtual int close_last(struct file *filp);
ssize_t read(file *filp, char *buffer, size_t len) override;
private:
void Run() override;
void Run() override;
/**
* Sample a single channel and return the measured value.
@@ -105,7 +100,7 @@ private:
ADC::ADC(uint32_t base_address, uint32_t channels) :
CDev(ADC0_DEVICE_PATH),
ScheduledWorkItem(MODULE_NAME, px4::wq_configurations::hp_default),
_sample_perf(perf_alloc(PC_ELAPSED, "adc_samples")),
_sample_perf(perf_alloc(PC_ELAPSED, MODULE_NAME": sample")),
_base_address(base_address)
{
/* always enable the temperature sensor */
@@ -140,6 +135,8 @@ ADC::ADC(uint32_t base_address, uint32_t channels) :
ADC::~ADC()
{
ScheduleClear();
if (_samples != nullptr) {
delete _samples;
}
@@ -151,21 +148,25 @@ ADC::~ADC()
int
ADC::init()
{
int rv = px4_arch_adc_init(_base_address);
int ret_init = px4_arch_adc_init(_base_address);
if (rv < 0) {
PX4_DEBUG("sample timeout");
return rv;
if (ret_init < 0) {
PX4_ERR("arch adc init failed");
return ret_init;
}
/* create the device node */
return CDev::init();
}
int ret_cdev = CDev::init();
int
ADC::ioctl(file *filp, int cmd, unsigned long arg)
{
return -ENOTTY;
if (ret_cdev != PX4_OK) {
PX4_ERR("CDev init failed");
return ret_cdev;
}
// schedule regular updates
ScheduleOnInterval(kINTERVAL, kINTERVAL);
return PX4_OK;
}
ssize_t
@@ -185,26 +186,6 @@ ADC::read(file *filp, char *buffer, size_t len)
return len;
}
int
ADC::open_first(struct file *filp)
{
/* get fresh data */
Run();
/* and schedule regular updates */
ScheduleOnInterval(kINTERVAL, kINTERVAL);
return 0;
}
int
ADC::close_last(struct file *filp)
{
ScheduleClear();
return 0;
}
void
ADC::Run()
{