fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-14 05:11:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

lis3mdl: move to PX4Magnetometer and cleanup

Browse Source
This commit is contained in:
Daniel Agar
2020-04-01 10:07:08 -04:00
parent cf12969a29
commit 5f6f1c554b
5 changed files with 58 additions and 688 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/magnetometer/lis3mdl/lis3mdl_i2c.cpp
+3 -23
View File
@@ -63,7 +63,6 @@ public:
LIS3MDL_I2C(int bus, int bus_frequency);
virtual ~LIS3MDL_I2C() = default;
virtual int ioctl(unsigned operation, unsigned &arg);
virtual int read(unsigned address, void *data, unsigned count);
virtual int write(unsigned address, void *data, unsigned count);
@@ -87,24 +86,7 @@ LIS3MDL_I2C::LIS3MDL_I2C(int bus, int bus_frequency) :
_device_id.devid_s.devtype = DRV_MAG_DEVTYPE_LIS3MDL;
}
int
LIS3MDL_I2C::ioctl(unsigned operation, unsigned &arg)
{
switch (operation) {
case MAGIOCGEXTERNAL:
return external();
case DEVIOCGDEVICEID:
return CDev::ioctl(nullptr, operation, arg);
default:
return -EINVAL;
}
}
int
LIS3MDL_I2C::probe()
int LIS3MDL_I2C::probe()
{
uint8_t data = 0;
@@ -125,15 +107,13 @@ LIS3MDL_I2C::probe()
return OK;
}
int
LIS3MDL_I2C::read(unsigned address, void *data, unsigned count)
int LIS3MDL_I2C::read(unsigned address, void *data, unsigned count)
{
uint8_t cmd = address;
return transfer(&cmd, 1, (uint8_t *)data, count);
}
int
LIS3MDL_I2C::write(unsigned address, void *data, unsigned count)
int LIS3MDL_I2C::write(unsigned address, void *data, unsigned count)
{
uint8_t buf[32];