123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670 |
- typedef struct LIS3MDLDriver LIS3MDLDriver;
- typedef enum {
- LIS3MDL_SAD_GND = 0x1C,
- LIS3MDL_SAD_VCC = 0x1E
- }lis3mdl_sad_t;
- typedef enum {
- LIS3MDL_COMP_FS_4GA = 0x00,
- LIS3MDL_COMP_FS_8GA = 0x20,
- LIS3MDL_COMP_FS_12GA = 0x40,
- LIS3MDL_COMP_FS_16GA = 0x60
- }lis3mdl_comp_fs_t;
- typedef enum {
- LIS3MDL_COMP_ODR_0_625HZ = 0x00,
- LIS3MDL_COMP_ODR_1_25HZ = 0x04,
- LIS3MDL_COMP_ODR_2_5HZ = 0x08,
- LIS3MDL_COMP_ODR_5HZ = 0x0C,
- LIS3MDL_COMP_ODR_10HZ = 0x10,
- LIS3MDL_COMP_ODR_20HZ = 0x14,
- LIS3MDL_COMP_ODR_40HZ = 0x18,
- LIS3MDL_COMP_ODR_80HZ = 0x1C
- }lis3mdl_comp_odr_t;
- typedef enum {
- LIS3MDL_COMP_LP_DISABLED = 0x00,
- LIS3MDL_COMP_LP_ENABLED = 0x20
- }lis3mdl_comp_lp_t;
- typedef enum {
- LIS3MDL_COMP_MD_CONTINUOUS = 0x00,
- LIS3MDL_COMP_MD_SINGLE = 0x01,
- LIS3MDL_COMP_MD_POWER_DOWN = 0x02
- }lis3mdl_comp_md_t;
- typedef enum {
- LIS3MDL_COMP_OMXY_LP = 0x00,
- LIS3MDL_COMP_OMXY_MEDIUM = 0x20,
- LIS3MDL_COMP_OMXY_HIGH = 0x40,
- LIS3MDL_COMP_OMXY_ULTRA = 0x60
- }lis3mdl_comp_omxy_t;
- typedef enum {
- LIS3MDL_COMP_OMZ_LP = 0x00,
- LIS3MDL_COMP_OMZ_MEDIUM = 0x04,
- LIS3MDL_COMP_OMZ_HIGH = 0x08,
- LIS3MDL_COMP_OMZ_ULTRA = 0x0C
- }lis3mdl_comp_omz_t;
- typedef enum {
- LIS3MDL_TEMP_DISABLED = 0x00,
- LIS3MDL_TEMP_ENABLED = 0x80
- }lis3mdl_temp_t;
- typedef enum {
- LIS3MDL_BDU_CONTINUOUS = 0x00,
- LIS3MDL_BDU_BLOCKED = 0x40
- }lis3mdl_bdu_t;
- typedef enum {
- LIS3MDL_END_LITTLE = 0x00,
- LIS3MDL_END_BIG = 0x02
- }lis3mdl_end_t;
- typedef enum {
- LIS3MDL_UNINIT = 0,
- LIS3MDL_STOP = 1,
- LIS3MDL_READY = 2,
- } lis3mdl_state_t;
- typedef struct {
-
- SPIDriver *spip;
-
- const SPIConfig *spicfg;
-
- I2CDriver *i2cp;
-
- const I2CConfig *i2ccfg;
-
- lis3mdl_sad_t slaveaddress;
-
- float *compsensitivity;
-
- float *compbias;
-
- lis3mdl_comp_fs_t compfullscale;
-
- lis3mdl_comp_odr_t compoutputdatarate;
-
- lis3mdl_comp_lp_t complowpowermode;
-
- lis3mdl_comp_md_t compconversionmode;
-
- lis3mdl_comp_omxy_t compoperationmodexy;
-
- lis3mdl_comp_omz_t compoperationmodez;
-
- lis3mdl_bdu_t blockdataupdate;
-
- lis3mdl_end_t endianness;
- } LIS3MDLConfig;
- \
- msg_t (*comp_set_full_scale)(LIS3MDLDriver *devp, lis3mdl_comp_fs_t fs);
- _base_object_methods \
- _lis3msl_methods_alone
- struct LIS3MDLVMT {
- _lis3mdl_methods
- };
- _base_compass_data \
- \
- lis3mdl_state_t state; \
- \
- const LIS3MDLConfig *config; \
- \
- size_t compaxes; \
- \
- float compsensitivity[LIS3MDL_COMP_NUMBER_OF_AXES]; \
- \
- float compbias[LIS3MDL_COMP_NUMBER_OF_AXES]; \
- \
- float compfullscale;
- struct LIS3MDLDriver {
-
- const struct LIS3MDLVMT *vmt;
-
- BaseCompass comp_if;
- _lis3mdl_data
- };
- compassGetAxesNumber(&((devp)->comp_if))
- compassReadRaw(&((devp)->comp_if), axes)
- compassReadCooked(&((devp)->comp_if), axes)
- compassSetBias(&((devp)->comp_if), bp)
- compassResetBias(&((devp)->comp_if))
- compassSetSensitivity(&((devp)->comp_if), sp)
- compassResetSensitivity(&((devp)->comp_if))
- (devp)->vmt->comp_set_full_scale(devp, fs)
- extern "C" {
- void lis3mdlObjectInit(LIS3MDLDriver *devp);
- void lis3mdlStart(LIS3MDLDriver *devp, const LIS3MDLConfig *config);
- void lis3mdlStop(LIS3MDLDriver *devp);
- }
|