1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264426542664267426842694270427142724273427442754276427742784279428042814282428342844285428642874288428942904291429242934294429542964297429842994300430143024303430443054306430743084309431043114312431343144315431643174318431943204321432243234324432543264327432843294330433143324333433443354336433743384339434043414342434343444345434643474348434943504351435243534354435543564357435843594360436143624363436443654366436743684369437043714372437343744375437643774378437943804381438243834384438543864387438843894390439143924393439443954396439743984399440044014402440344044405440644074408440944104411441244134414441544164417441844194420442144224423442444254426442744284429443044314432443344344435443644374438443944404441444244434444444544464447444844494450445144524453445444554456445744584459446044614462446344644465446644674468446944704471447244734474447544764477447844794480448144824483448444854486448744884489449044914492449344944495449644974498449945004501450245034504450545064507450845094510451145124513451445154516451745184519452045214522452345244525452645274528452945304531453245334534453545364537453845394540454145424543454445454546454745484549455045514552455345544555455645574558455945604561456245634564456545664567456845694570457145724573457445754576457745784579458045814582458345844585458645874588458945904591459245934594459545964597459845994600460146024603460446054606460746084609461046114612461346144615461646174618461946204621462246234624462546264627462846294630463146324633463446354636463746384639464046414642464346444645464646474648464946504651465246534654465546564657465846594660466146624663466446654666466746684669467046714672467346744675467646774678467946804681468246834684468546864687468846894690469146924693469446954696469746984699470047014702470347044705470647074708470947104711471247134714471547164717471847194720472147224723472447254726472747284729473047314732473347344735473647374738473947404741474247434744474547464747474847494750475147524753475447554756475747584759476047614762476347644765476647674768476947704771477247734774477547764777477847794780478147824783478447854786478747884789479047914792479347944795479647974798479948004801480248034804480548064807480848094810481148124813481448154816481748184819482048214822482348244825482648274828482948304831483248334834483548364837483848394840484148424843484448454846484748484849485048514852485348544855485648574858485948604861486248634864486548664867486848694870487148724873487448754876487748784879488048814882488348844885488648874888488948904891489248934894489548964897489848994900490149024903490449054906490749084909491049114912491349144915491649174918491949204921492249234924492549264927492849294930493149324933493449354936493749384939494049414942494349444945494649474948494949504951495249534954495549564957495849594960496149624963496449654966496749684969497049714972497349744975497649774978497949804981498249834984498549864987498849894990499149924993499449954996499749984999500050015002500350045005500650075008500950105011501250135014501550165017501850195020502150225023502450255026502750285029503050315032503350345035503650375038503950405041504250435044504550465047504850495050505150525053505450555056505750585059506050615062506350645065506650675068506950705071507250735074507550765077507850795080508150825083508450855086508750885089509050915092509350945095509650975098509951005101510251035104510551065107510851095110511151125113511451155116511751185119512051215122512351245125512651275128512951305131513251335134513551365137513851395140514151425143514451455146514751485149515051515152515351545155515651575158515951605161516251635164516551665167516851695170517151725173517451755176517751785179518051815182518351845185518651875188518951905191519251935194519551965197519851995200520152025203520452055206520752085209521052115212521352145215521652175218521952205221522252235224522552265227522852295230523152325233523452355236523752385239524052415242524352445245524652475248524952505251525252535254525552565257525852595260526152625263526452655266526752685269527052715272527352745275527652775278527952805281528252835284528552865287528852895290529152925293529452955296529752985299530053015302530353045305530653075308530953105311531253135314531553165317531853195320532153225323532453255326532753285329533053315332533353345335533653375338533953405341534253435344534553465347534853495350535153525353535453555356535753585359536053615362536353645365536653675368536953705371537253735374537553765377537853795380538153825383538453855386538753885389539053915392539353945395539653975398539954005401540254035404540554065407540854095410541154125413541454155416541754185419542054215422542354245425542654275428542954305431543254335434543554365437543854395440544154425443544454455446544754485449545054515452545354545455545654575458545954605461546254635464546554665467546854695470547154725473547454755476547754785479548054815482548354845485548654875488548954905491549254935494549554965497549854995500550155025503550455055506550755085509551055115512551355145515551655175518551955205521552255235524552555265527552855295530553155325533553455355536553755385539554055415542554355445545554655475548554955505551555255535554555555565557555855595560556155625563556455655566556755685569557055715572557355745575557655775578557955805581558255835584558555865587558855895590559155925593559455955596559755985599560056015602560356045605560656075608560956105611561256135614561556165617561856195620562156225623562456255626562756285629563056315632563356345635563656375638563956405641564256435644564556465647564856495650565156525653565456555656565756585659566056615662566356645665566656675668566956705671567256735674567556765677567856795680568156825683568456855686568756885689569056915692569356945695569656975698569957005701570257035704570557065707570857095710571157125713571457155716571757185719572057215722572357245725572657275728572957305731573257335734573557365737573857395740574157425743574457455746574757485749575057515752575357545755575657575758575957605761576257635764576557665767576857695770577157725773577457755776577757785779578057815782578357845785578657875788578957905791579257935794579557965797579857995800580158025803580458055806580758085809581058115812581358145815581658175818581958205821582258235824582558265827582858295830583158325833583458355836583758385839584058415842584358445845584658475848584958505851585258535854585558565857585858595860586158625863586458655866586758685869587058715872587358745875587658775878587958805881588258835884588558865887588858895890589158925893589458955896589758985899590059015902590359045905590659075908590959105911591259135914591559165917591859195920592159225923592459255926592759285929593059315932593359345935593659375938593959405941594259435944594559465947594859495950595159525953595459555956595759585959596059615962596359645965596659675968596959705971597259735974597559765977597859795980598159825983598459855986598759885989599059915992599359945995599659975998599960006001600260036004600560066007600860096010601160126013601460156016601760186019602060216022602360246025602660276028602960306031603260336034603560366037603860396040604160426043604460456046604760486049605060516052605360546055605660576058605960606061606260636064606560666067606860696070607160726073607460756076607760786079608060816082608360846085608660876088608960906091609260936094609560966097609860996100610161026103610461056106610761086109611061116112611361146115611661176118611961206121612261236124612561266127612861296130613161326133613461356136613761386139614061416142614361446145614661476148614961506151615261536154615561566157615861596160616161626163616461656166616761686169617061716172617361746175617661776178617961806181618261836184618561866187618861896190619161926193619461956196619761986199620062016202620362046205620662076208620962106211621262136214621562166217621862196220622162226223622462256226622762286229623062316232623362346235623662376238623962406241624262436244624562466247624862496250625162526253625462556256625762586259626062616262626362646265626662676268626962706271627262736274627562766277627862796280628162826283628462856286628762886289629062916292629362946295629662976298629963006301630263036304630563066307630863096310631163126313631463156316631763186319632063216322632363246325632663276328632963306331633263336334633563366337633863396340634163426343634463456346634763486349635063516352635363546355635663576358635963606361636263636364636563666367636863696370637163726373637463756376637763786379638063816382638363846385638663876388638963906391639263936394639563966397639863996400640164026403640464056406640764086409641064116412641364146415641664176418641964206421642264236424642564266427642864296430643164326433643464356436643764386439644064416442644364446445644664476448644964506451645264536454645564566457645864596460646164626463646464656466646764686469647064716472647364746475647664776478647964806481648264836484648564866487648864896490649164926493649464956496649764986499650065016502650365046505650665076508650965106511651265136514651565166517651865196520652165226523652465256526652765286529653065316532653365346535653665376538653965406541654265436544654565466547654865496550655165526553655465556556655765586559656065616562656365646565656665676568656965706571657265736574657565766577657865796580658165826583658465856586658765886589659065916592659365946595659665976598659966006601660266036604660566066607660866096610661166126613661466156616661766186619662066216622662366246625662666276628662966306631663266336634663566366637663866396640664166426643664466456646664766486649665066516652665366546655665666576658665966606661666266636664666566666667666866696670667166726673667466756676667766786679668066816682668366846685668666876688668966906691669266936694669566966697669866996700670167026703670467056706670767086709671067116712671367146715671667176718671967206721672267236724672567266727672867296730673167326733673467356736673767386739674067416742674367446745674667476748674967506751675267536754675567566757675867596760676167626763676467656766676767686769677067716772677367746775677667776778677967806781678267836784678567866787678867896790679167926793679467956796679767986799680068016802680368046805680668076808680968106811681268136814681568166817681868196820682168226823682468256826682768286829683068316832683368346835683668376838683968406841684268436844684568466847684868496850685168526853685468556856685768586859686068616862686368646865686668676868686968706871687268736874687568766877687868796880688168826883688468856886688768886889689068916892689368946895689668976898689969006901690269036904690569066907690869096910691169126913691469156916691769186919692069216922692369246925692669276928692969306931693269336934693569366937693869396940694169426943694469456946694769486949695069516952695369546955695669576958695969606961696269636964696569666967696869696970697169726973697469756976697769786979698069816982698369846985698669876988698969906991699269936994699569966997699869997000700170027003700470057006700770087009701070117012701370147015701670177018701970207021702270237024702570267027702870297030703170327033703470357036703770387039704070417042704370447045704670477048704970507051705270537054705570567057705870597060706170627063706470657066706770687069707070717072707370747075707670777078707970807081708270837084708570867087708870897090709170927093709470957096709770987099710071017102710371047105710671077108710971107111711271137114711571167117711871197120712171227123712471257126712771287129713071317132713371347135713671377138713971407141714271437144714571467147714871497150715171527153715471557156715771587159716071617162716371647165716671677168716971707171717271737174717571767177717871797180718171827183718471857186718771887189719071917192719371947195719671977198719972007201720272037204720572067207720872097210721172127213721472157216721772187219722072217222722372247225722672277228722972307231723272337234723572367237723872397240724172427243724472457246724772487249725072517252725372547255725672577258725972607261726272637264726572667267726872697270727172727273727472757276727772787279728072817282728372847285728672877288728972907291729272937294729572967297729872997300730173027303730473057306730773087309731073117312731373147315731673177318731973207321732273237324732573267327732873297330733173327333733473357336733773387339734073417342734373447345734673477348734973507351735273537354735573567357735873597360736173627363736473657366736773687369737073717372737373747375737673777378737973807381738273837384738573867387738873897390739173927393739473957396739773987399740074017402740374047405740674077408740974107411741274137414741574167417741874197420742174227423742474257426742774287429743074317432743374347435743674377438743974407441744274437444744574467447744874497450745174527453745474557456745774587459746074617462746374647465746674677468746974707471747274737474747574767477747874797480748174827483748474857486748774887489749074917492749374947495749674977498749975007501750275037504750575067507750875097510751175127513751475157516751775187519752075217522752375247525752675277528752975307531753275337534753575367537753875397540754175427543754475457546754775487549755075517552755375547555755675577558755975607561756275637564756575667567756875697570757175727573757475757576757775787579758075817582758375847585758675877588758975907591759275937594759575967597759875997600760176027603760476057606760776087609761076117612761376147615761676177618761976207621762276237624762576267627762876297630763176327633763476357636763776387639764076417642764376447645764676477648764976507651765276537654765576567657765876597660766176627663766476657666766776687669767076717672767376747675767676777678767976807681768276837684768576867687768876897690769176927693769476957696769776987699770077017702770377047705770677077708770977107711771277137714771577167717771877197720772177227723772477257726772777287729773077317732773377347735773677377738773977407741774277437744774577467747774877497750775177527753775477557756775777587759776077617762776377647765776677677768776977707771777277737774777577767777777877797780778177827783778477857786778777887789779077917792779377947795779677977798779978007801780278037804780578067807780878097810781178127813781478157816781778187819782078217822782378247825782678277828782978307831783278337834783578367837783878397840784178427843784478457846784778487849785078517852785378547855785678577858785978607861786278637864786578667867786878697870787178727873787478757876787778787879788078817882788378847885788678877888788978907891789278937894789578967897789878997900790179027903790479057906790779087909791079117912791379147915791679177918791979207921792279237924792579267927792879297930793179327933793479357936793779387939794079417942794379447945794679477948794979507951795279537954795579567957795879597960796179627963796479657966796779687969797079717972797379747975797679777978797979807981798279837984798579867987798879897990799179927993799479957996799779987999800080018002800380048005800680078008800980108011801280138014801580168017801880198020802180228023802480258026802780288029803080318032803380348035803680378038803980408041804280438044804580468047804880498050805180528053805480558056805780588059806080618062806380648065806680678068806980708071807280738074807580768077807880798080808180828083808480858086808780888089809080918092809380948095809680978098809981008101810281038104810581068107810881098110811181128113811481158116811781188119812081218122812381248125812681278128812981308131813281338134813581368137813881398140814181428143814481458146814781488149815081518152815381548155815681578158815981608161816281638164816581668167816881698170817181728173817481758176817781788179818081818182818381848185818681878188818981908191819281938194819581968197819881998200820182028203820482058206820782088209 |
- /**
- ******************************************************************************
- * @file lsm6ds3tr_c_reg.c
- * @author Sensors Software Solution Team
- * @brief LSM6DS3TR_C driver file
- ******************************************************************************
- * @attention
- *
- * <h2><center>© Copyright (c) 2021 STMicroelectronics.
- * All rights reserved.</center></h2>
- *
- * This software component is licensed by ST under BSD 3-Clause license,
- * the "License"; You may not use this file except in compliance with the
- * License. You may obtain a copy of the License at:
- * opensource.org/licenses/BSD-3-Clause
- *
- ******************************************************************************
- */
- #include "lsm6ds3tr-c_reg.h"
- /**
- * @defgroup LSM6DS3TR_C
- * @brief This file provides a set of functions needed to drive the
- * lsm6ds3tr_c enanced inertial module.
- * @{
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_interfaces_functions
- * @brief This section provide a set of functions used to read and
- * write a generic register of the device.
- * MANDATORY: return 0 -> no Error.
- * @{
- *
- */
- /**
- * @brief Read generic device register
- *
- * @param ctx read / write interface definitions(ptr)
- * @param reg register to read
- * @param data pointer to buffer that store the data read(ptr)
- * @param len number of consecutive register to read
- * @retval interface status (MANDATORY: return 0 -> no Error)
- *
- */
- int32_t lsm6ds3tr_c_read_reg(stmdev_ctx_t *ctx, uint8_t reg,
- uint8_t *data,
- uint16_t len)
- {
- int32_t ret;
- ret = ctx->read_reg(ctx->handle, reg, data, len);
- return ret;
- }
- /**
- * @brief Write generic device register
- *
- * @param ctx read / write interface definitions(ptr)
- * @param reg register to write
- * @param data pointer to data to write in register reg(ptr)
- * @param len number of consecutive register to write
- * @retval interface status (MANDATORY: return 0 -> no Error)
- *
- */
- int32_t lsm6ds3tr_c_write_reg(stmdev_ctx_t *ctx, uint8_t reg,
- uint8_t *data,
- uint16_t len)
- {
- int32_t ret;
- ret = ctx->write_reg(ctx->handle, reg, data, len);
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_Sensitivity
- * @brief These functions convert raw-data into engineering units.
- * @{
- *
- */
- float_t lsm6ds3tr_c_from_fs2g_to_mg(int16_t lsb)
- {
- return ((float_t)lsb * 0.061f);
- }
- float_t lsm6ds3tr_c_from_fs4g_to_mg(int16_t lsb)
- {
- return ((float_t)lsb * 0.122f);
- }
- float_t lsm6ds3tr_c_from_fs8g_to_mg(int16_t lsb)
- {
- return ((float_t)lsb * 0.244f);
- }
- float_t lsm6ds3tr_c_from_fs16g_to_mg(int16_t lsb)
- {
- return ((float_t)lsb * 0.488f);
- }
- float_t lsm6ds3tr_c_from_fs125dps_to_mdps(int16_t lsb)
- {
- return ((float_t)lsb * 4.375f);
- }
- float_t lsm6ds3tr_c_from_fs250dps_to_mdps(int16_t lsb)
- {
- return ((float_t)lsb * 8.750f);
- }
- float_t lsm6ds3tr_c_from_fs500dps_to_mdps(int16_t lsb)
- {
- return ((float_t)lsb * 17.50f);
- }
- float_t lsm6ds3tr_c_from_fs1000dps_to_mdps(int16_t lsb)
- {
- return ((float_t)lsb * 35.0f);
- }
- float_t lsm6ds3tr_c_from_fs2000dps_to_mdps(int16_t lsb)
- {
- return ((float_t)lsb * 70.0f);
- }
- float_t lsm6ds3tr_c_from_lsb_to_celsius(int16_t lsb)
- {
- return (((float_t)lsb / 256.0f) + 25.0f);
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_data_generation
- * @brief This section groups all the functions concerning data
- * generation
- * @{
- *
- */
- /**
- * @brief Accelerometer full-scale selection.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of fs_xl in reg CTRL1_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_full_scale_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_fs_xl_t val)
- {
- lsm6ds3tr_c_ctrl1_xl_t ctrl1_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL1_XL,
- (uint8_t *)&ctrl1_xl, 1);
- if (ret == 0)
- {
- ctrl1_xl.fs_xl = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL1_XL,
- (uint8_t *)&ctrl1_xl, 1);
- }
- return ret;
- }
- /**
- * @brief Accelerometer full-scale selection.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of fs_xl in reg CTRL1_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_full_scale_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_fs_xl_t *val)
- {
- lsm6ds3tr_c_ctrl1_xl_t ctrl1_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL1_XL,
- (uint8_t *)&ctrl1_xl, 1);
- switch (ctrl1_xl.fs_xl)
- {
- case LSM6DS3TR_C_2g:
- *val = LSM6DS3TR_C_2g;
- break;
- case LSM6DS3TR_C_16g:
- *val = LSM6DS3TR_C_16g;
- break;
- case LSM6DS3TR_C_4g:
- *val = LSM6DS3TR_C_4g;
- break;
- case LSM6DS3TR_C_8g:
- *val = LSM6DS3TR_C_8g;
- break;
- default:
- *val = LSM6DS3TR_C_XL_FS_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Accelerometer data rate selection.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of odr_xl in reg CTRL1_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_data_rate_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_odr_xl_t val)
- {
- lsm6ds3tr_c_ctrl1_xl_t ctrl1_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL1_XL,
- (uint8_t *)&ctrl1_xl, 1);
- if (ret == 0)
- {
- ctrl1_xl.odr_xl = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL1_XL,
- (uint8_t *)&ctrl1_xl, 1);
- }
- return ret;
- }
- /**
- * @brief Accelerometer data rate selection.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of odr_xl in reg CTRL1_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_data_rate_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_odr_xl_t *val)
- {
- lsm6ds3tr_c_ctrl1_xl_t ctrl1_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL1_XL,
- (uint8_t *)&ctrl1_xl, 1);
- switch (ctrl1_xl.odr_xl)
- {
- case LSM6DS3TR_C_XL_ODR_OFF:
- *val = LSM6DS3TR_C_XL_ODR_OFF;
- break;
- case LSM6DS3TR_C_XL_ODR_12Hz5:
- *val = LSM6DS3TR_C_XL_ODR_12Hz5;
- break;
- case LSM6DS3TR_C_XL_ODR_26Hz:
- *val = LSM6DS3TR_C_XL_ODR_26Hz;
- break;
- case LSM6DS3TR_C_XL_ODR_52Hz:
- *val = LSM6DS3TR_C_XL_ODR_52Hz;
- break;
- case LSM6DS3TR_C_XL_ODR_104Hz:
- *val = LSM6DS3TR_C_XL_ODR_104Hz;
- break;
- case LSM6DS3TR_C_XL_ODR_208Hz:
- *val = LSM6DS3TR_C_XL_ODR_208Hz;
- break;
- case LSM6DS3TR_C_XL_ODR_416Hz:
- *val = LSM6DS3TR_C_XL_ODR_416Hz;
- break;
- case LSM6DS3TR_C_XL_ODR_833Hz:
- *val = LSM6DS3TR_C_XL_ODR_833Hz;
- break;
- case LSM6DS3TR_C_XL_ODR_1k66Hz:
- *val = LSM6DS3TR_C_XL_ODR_1k66Hz;
- break;
- case LSM6DS3TR_C_XL_ODR_3k33Hz:
- *val = LSM6DS3TR_C_XL_ODR_3k33Hz;
- break;
- case LSM6DS3TR_C_XL_ODR_6k66Hz:
- *val = LSM6DS3TR_C_XL_ODR_6k66Hz;
- break;
- case LSM6DS3TR_C_XL_ODR_1Hz6:
- *val = LSM6DS3TR_C_XL_ODR_1Hz6;
- break;
- default:
- *val = LSM6DS3TR_C_XL_ODR_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Gyroscope chain full-scale selection.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of fs_g in reg CTRL2_G
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_full_scale_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_fs_g_t val)
- {
- lsm6ds3tr_c_ctrl2_g_t ctrl2_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL2_G,
- (uint8_t *)&ctrl2_g, 1);
- if (ret == 0)
- {
- ctrl2_g.fs_g = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL2_G,
- (uint8_t *)&ctrl2_g, 1);
- }
- return ret;
- }
- /**
- * @brief Gyroscope chain full-scale selection.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of fs_g in reg CTRL2_G
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_full_scale_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_fs_g_t *val)
- {
- lsm6ds3tr_c_ctrl2_g_t ctrl2_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL2_G,
- (uint8_t *)&ctrl2_g, 1);
- switch (ctrl2_g.fs_g)
- {
- case LSM6DS3TR_C_250dps:
- *val = LSM6DS3TR_C_250dps;
- break;
- case LSM6DS3TR_C_125dps:
- *val = LSM6DS3TR_C_125dps;
- break;
- case LSM6DS3TR_C_500dps:
- *val = LSM6DS3TR_C_500dps;
- break;
- case LSM6DS3TR_C_1000dps:
- *val = LSM6DS3TR_C_1000dps;
- break;
- case LSM6DS3TR_C_2000dps:
- *val = LSM6DS3TR_C_2000dps;
- break;
- default:
- *val = LSM6DS3TR_C_GY_FS_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Gyroscope data rate selection.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of odr_g in reg CTRL2_G
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_data_rate_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_odr_g_t val)
- {
- lsm6ds3tr_c_ctrl2_g_t ctrl2_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL2_G,
- (uint8_t *)&ctrl2_g, 1);
- if (ret == 0)
- {
- ctrl2_g.odr_g = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL2_G,
- (uint8_t *)&ctrl2_g, 1);
- }
- return ret;
- }
- /**
- * @brief Gyroscope data rate selection.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of odr_g in reg CTRL2_G
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_data_rate_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_odr_g_t *val)
- {
- lsm6ds3tr_c_ctrl2_g_t ctrl2_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL2_G,
- (uint8_t *)&ctrl2_g, 1);
- switch (ctrl2_g.odr_g)
- {
- case LSM6DS3TR_C_GY_ODR_OFF:
- *val = LSM6DS3TR_C_GY_ODR_OFF;
- break;
- case LSM6DS3TR_C_GY_ODR_12Hz5:
- *val = LSM6DS3TR_C_GY_ODR_12Hz5;
- break;
- case LSM6DS3TR_C_GY_ODR_26Hz:
- *val = LSM6DS3TR_C_GY_ODR_26Hz;
- break;
- case LSM6DS3TR_C_GY_ODR_52Hz:
- *val = LSM6DS3TR_C_GY_ODR_52Hz;
- break;
- case LSM6DS3TR_C_GY_ODR_104Hz:
- *val = LSM6DS3TR_C_GY_ODR_104Hz;
- break;
- case LSM6DS3TR_C_GY_ODR_208Hz:
- *val = LSM6DS3TR_C_GY_ODR_208Hz;
- break;
- case LSM6DS3TR_C_GY_ODR_416Hz:
- *val = LSM6DS3TR_C_GY_ODR_416Hz;
- break;
- case LSM6DS3TR_C_GY_ODR_833Hz:
- *val = LSM6DS3TR_C_GY_ODR_833Hz;
- break;
- case LSM6DS3TR_C_GY_ODR_1k66Hz:
- *val = LSM6DS3TR_C_GY_ODR_1k66Hz;
- break;
- case LSM6DS3TR_C_GY_ODR_3k33Hz:
- *val = LSM6DS3TR_C_GY_ODR_3k33Hz;
- break;
- case LSM6DS3TR_C_GY_ODR_6k66Hz:
- *val = LSM6DS3TR_C_GY_ODR_6k66Hz;
- break;
- default:
- *val = LSM6DS3TR_C_GY_ODR_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Block data update.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of bdu in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_block_data_update_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- if (ret == 0)
- {
- ctrl3_c.bdu = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- }
- return ret;
- }
- /**
- * @brief Block data update.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of bdu in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_block_data_update_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- *val = ctrl3_c.bdu;
- return ret;
- }
- /**
- * @brief Weight of XL user offset bits of registers
- * X_OFS_USR(73h), Y_OFS_USR(74h), Z_OFS_USR(75h).[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of usr_off_w in reg CTRL6_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_offset_weight_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_usr_off_w_t val)
- {
- lsm6ds3tr_c_ctrl6_c_t ctrl6_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL6_C,
- (uint8_t *)&ctrl6_c, 1);
- if (ret == 0)
- {
- ctrl6_c.usr_off_w = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL6_C,
- (uint8_t *)&ctrl6_c, 1);
- }
- return ret;
- }
- /**
- * @brief Weight of XL user offset bits of registers
- * X_OFS_USR(73h), Y_OFS_USR(74h), Z_OFS_USR(75h).[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of usr_off_w in reg CTRL6_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_offset_weight_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_usr_off_w_t *val)
- {
- lsm6ds3tr_c_ctrl6_c_t ctrl6_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL6_C,
- (uint8_t *)&ctrl6_c, 1);
- switch (ctrl6_c.usr_off_w)
- {
- case LSM6DS3TR_C_LSb_1mg:
- *val = LSM6DS3TR_C_LSb_1mg;
- break;
- case LSM6DS3TR_C_LSb_16mg:
- *val = LSM6DS3TR_C_LSb_16mg;
- break;
- default:
- *val = LSM6DS3TR_C_WEIGHT_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief High-performance operating mode for accelerometer[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of xl_hm_mode in reg CTRL6_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_power_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_xl_hm_mode_t val)
- {
- lsm6ds3tr_c_ctrl6_c_t ctrl6_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL6_C,
- (uint8_t *)&ctrl6_c, 1);
- if (ret == 0)
- {
- ctrl6_c.xl_hm_mode = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL6_C,
- (uint8_t *)&ctrl6_c, 1);
- }
- return ret;
- }
- /**
- * @brief High-performance operating mode for accelerometer.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of xl_hm_mode in reg CTRL6_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_power_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_xl_hm_mode_t *val)
- {
- lsm6ds3tr_c_ctrl6_c_t ctrl6_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL6_C,
- (uint8_t *)&ctrl6_c, 1);
- switch (ctrl6_c.xl_hm_mode)
- {
- case LSM6DS3TR_C_XL_HIGH_PERFORMANCE:
- *val = LSM6DS3TR_C_XL_HIGH_PERFORMANCE;
- break;
- case LSM6DS3TR_C_XL_NORMAL:
- *val = LSM6DS3TR_C_XL_NORMAL;
- break;
- default:
- *val = LSM6DS3TR_C_XL_PW_MODE_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Source register rounding function on WAKE_UP_SRC (1Bh),
- * TAP_SRC (1Ch), D6D_SRC (1Dh), STATUS_REG (1Eh) and
- * FUNC_SRC1 (53h) registers in the primary interface.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of rounding_status in reg CTRL7_G
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_rounding_on_status_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_rounding_status_t val)
- {
- lsm6ds3tr_c_ctrl7_g_t ctrl7_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL7_G,
- (uint8_t *)&ctrl7_g, 1);
- if (ret == 0)
- {
- ctrl7_g.rounding_status = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL7_G,
- (uint8_t *)&ctrl7_g, 1);
- }
- return ret;
- }
- /**
- * @brief Source register rounding function on WAKE_UP_SRC (1Bh),
- * TAP_SRC (1Ch), D6D_SRC (1Dh), STATUS_REG (1Eh) and
- * FUNC_SRC1 (53h) registers in the primary interface.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of rounding_status in reg CTRL7_G
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_rounding_on_status_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_rounding_status_t *val)
- {
- lsm6ds3tr_c_ctrl7_g_t ctrl7_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL7_G,
- (uint8_t *)&ctrl7_g, 1);
- switch (ctrl7_g.rounding_status)
- {
- case LSM6DS3TR_C_STAT_RND_DISABLE:
- *val = LSM6DS3TR_C_STAT_RND_DISABLE;
- break;
- case LSM6DS3TR_C_STAT_RND_ENABLE:
- *val = LSM6DS3TR_C_STAT_RND_ENABLE;
- break;
- default:
- *val = LSM6DS3TR_C_STAT_RND_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief High-performance operating mode disable for gyroscope.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of g_hm_mode in reg CTRL7_G
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_power_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_g_hm_mode_t val)
- {
- lsm6ds3tr_c_ctrl7_g_t ctrl7_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL7_G,
- (uint8_t *)&ctrl7_g, 1);
- if (ret == 0)
- {
- ctrl7_g.g_hm_mode = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL7_G,
- (uint8_t *)&ctrl7_g, 1);
- }
- return ret;
- }
- /**
- * @brief High-performance operating mode disable for gyroscope.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of g_hm_mode in reg CTRL7_G
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_power_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_g_hm_mode_t *val)
- {
- lsm6ds3tr_c_ctrl7_g_t ctrl7_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL7_G,
- (uint8_t *)&ctrl7_g, 1);
- switch (ctrl7_g.g_hm_mode)
- {
- case LSM6DS3TR_C_GY_HIGH_PERFORMANCE:
- *val = LSM6DS3TR_C_GY_HIGH_PERFORMANCE;
- break;
- case LSM6DS3TR_C_GY_NORMAL:
- *val = LSM6DS3TR_C_GY_NORMAL;
- break;
- default:
- *val = LSM6DS3TR_C_GY_PW_MODE_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Read all the interrupt/status flag of the device.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val WAKE_UP_SRC, TAP_SRC, D6D_SRC, STATUS_REG,
- * FUNC_SRC1, FUNC_SRC2, WRIST_TILT_IA, A_WRIST_TILT_Mask
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_all_sources_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_all_sources_t *val)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_SRC,
- (uint8_t *) & (val->wake_up_src), 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_SRC,
- (uint8_t *) & (val->tap_src), 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_D6D_SRC,
- (uint8_t *) & (val->d6d_src), 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_STATUS_REG,
- (uint8_t *) & (val->status_reg), 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FUNC_SRC1,
- (uint8_t *) & (val->func_src1), 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FUNC_SRC2,
- (uint8_t *) & (val->func_src2), 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WRIST_TILT_IA,
- (uint8_t *) & (val->wrist_tilt_ia), 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_B);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_A_WRIST_TILT_MASK,
- (uint8_t *) & (val->a_wrist_tilt_mask), 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- return ret;
- }
- /**
- * @brief The STATUS_REG register is read by the primary interface[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Registers STATUS_REG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_status_reg_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_status_reg_t *val)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_STATUS_REG,
- (uint8_t *) val, 1);
- return ret;
- }
- /**
- * @brief Accelerometer new data available.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of xlda in reg STATUS_REG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_flag_data_ready_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_status_reg_t status_reg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_STATUS_REG,
- (uint8_t *)&status_reg, 1);
- *val = status_reg.xlda;
- return ret;
- }
- /**
- * @brief Gyroscope new data available.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of gda in reg STATUS_REG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_flag_data_ready_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_status_reg_t status_reg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_STATUS_REG,
- (uint8_t *)&status_reg, 1);
- *val = status_reg.gda;
- return ret;
- }
- /**
- * @brief Temperature new data available.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tda in reg STATUS_REG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_temp_flag_data_ready_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_status_reg_t status_reg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_STATUS_REG,
- (uint8_t *)&status_reg, 1);
- *val = status_reg.tda;
- return ret;
- }
- /**
- * @brief Accelerometer axis user offset correction expressed in two’s
- * complement, weight depends on USR_OFF_W in CTRL6_C.
- * The value must be in the range [-127 127].[set]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that contains data to write
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_usr_offset_set(stmdev_ctx_t *ctx,
- uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_X_OFS_USR, buff, 3);
- return ret;
- }
- /**
- * @brief Accelerometer axis user offset correction xpressed in two’s
- * complement, weight depends on USR_OFF_W in CTRL6_C.
- * The value must be in the range [-127 127].[get]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that stores data read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_usr_offset_get(stmdev_ctx_t *ctx,
- uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_X_OFS_USR, buff, 3);
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_Timestamp
- * @brief This section groups all the functions that manage the
- * timestamp generation.
- * @{
- *
- */
- /**
- * @brief Enable timestamp count. The count is saved in TIMESTAMP0_REG (40h),
- * TIMESTAMP1_REG (41h) and TIMESTAMP2_REG (42h).[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of timer_en in reg CTRL10_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_timestamp_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- if (ret == 0)
- {
- ctrl10_c.timer_en = val;
- if (val != 0x00U)
- {
- ctrl10_c.func_en = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- }
- }
- return ret;
- }
- /**
- * @brief Enable timestamp count. The count is saved in TIMESTAMP0_REG (40h),
- * TIMESTAMP1_REG (41h) and TIMESTAMP2_REG (42h).[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of timer_en in reg CTRL10_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_timestamp_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- *val = ctrl10_c.timer_en;
- return ret;
- }
- /**
- * @brief Timestamp register resolution setting.
- * Configuration of this bit affects
- * TIMESTAMP0_REG(40h), TIMESTAMP1_REG(41h),
- * TIMESTAMP2_REG(42h), STEP_TIMESTAMP_L(49h),
- * STEP_TIMESTAMP_H(4Ah) and
- * STEP_COUNT_DELTA(15h) registers.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of timer_hr in reg WAKE_UP_DUR
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_timestamp_res_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_timer_hr_t val)
- {
- lsm6ds3tr_c_wake_up_dur_t wake_up_dur;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_DUR,
- (uint8_t *)&wake_up_dur, 1);
- if (ret == 0)
- {
- wake_up_dur.timer_hr = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_WAKE_UP_DUR,
- (uint8_t *)&wake_up_dur, 1);
- }
- return ret;
- }
- /**
- * @brief Timestamp register resolution setting.
- * Configuration of this bit affects
- * TIMESTAMP0_REG(40h), TIMESTAMP1_REG(41h),
- * TIMESTAMP2_REG(42h), STEP_TIMESTAMP_L(49h),
- * STEP_TIMESTAMP_H(4Ah) and
- * STEP_COUNT_DELTA(15h) registers.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of timer_hr in reg WAKE_UP_DUR
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_timestamp_res_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_timer_hr_t *val)
- {
- lsm6ds3tr_c_wake_up_dur_t wake_up_dur;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_DUR,
- (uint8_t *)&wake_up_dur, 1);
- switch (wake_up_dur.timer_hr)
- {
- case LSM6DS3TR_C_LSB_6ms4:
- *val = LSM6DS3TR_C_LSB_6ms4;
- break;
- case LSM6DS3TR_C_LSB_25us:
- *val = LSM6DS3TR_C_LSB_25us;
- break;
- default:
- *val = LSM6DS3TR_C_TS_RES_ND;
- break;
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_Dataoutput
- * @brief This section groups all the data output functions.
- * @{
- *
- */
- /**
- * @brief Circular burst-mode (rounding) read from output registers
- * through the primary interface.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of rounding in reg CTRL5_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_rounding_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_rounding_t val)
- {
- lsm6ds3tr_c_ctrl5_c_t ctrl5_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL5_C,
- (uint8_t *)&ctrl5_c, 1);
- if (ret == 0)
- {
- ctrl5_c.rounding = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL5_C,
- (uint8_t *)&ctrl5_c, 1);
- }
- return ret;
- }
- /**
- * @brief Circular burst-mode (rounding) read from output registers
- * through the primary interface.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of rounding in reg CTRL5_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_rounding_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_rounding_t *val)
- {
- lsm6ds3tr_c_ctrl5_c_t ctrl5_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL5_C,
- (uint8_t *)&ctrl5_c, 1);
- switch (ctrl5_c.rounding)
- {
- case LSM6DS3TR_C_ROUND_DISABLE:
- *val = LSM6DS3TR_C_ROUND_DISABLE;
- break;
- case LSM6DS3TR_C_ROUND_XL:
- *val = LSM6DS3TR_C_ROUND_XL;
- break;
- case LSM6DS3TR_C_ROUND_GY:
- *val = LSM6DS3TR_C_ROUND_GY;
- break;
- case LSM6DS3TR_C_ROUND_GY_XL:
- *val = LSM6DS3TR_C_ROUND_GY_XL;
- break;
- case LSM6DS3TR_C_ROUND_SH1_TO_SH6:
- *val = LSM6DS3TR_C_ROUND_SH1_TO_SH6;
- break;
- case LSM6DS3TR_C_ROUND_XL_SH1_TO_SH6:
- *val = LSM6DS3TR_C_ROUND_XL_SH1_TO_SH6;
- break;
- case LSM6DS3TR_C_ROUND_GY_XL_SH1_TO_SH12:
- *val = LSM6DS3TR_C_ROUND_GY_XL_SH1_TO_SH12;
- break;
- case LSM6DS3TR_C_ROUND_GY_XL_SH1_TO_SH6:
- *val = LSM6DS3TR_C_ROUND_GY_XL_SH1_TO_SH6;
- break;
- default:
- *val = LSM6DS3TR_C_ROUND_OUT_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Temperature data output register (r). L and H registers together
- * express a 16-bit word in two’s complement.[get]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that stores data read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_temperature_raw_get(stmdev_ctx_t *ctx,
- int16_t *val)
- {
- uint8_t buff[2];
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_OUT_TEMP_L, buff, 2);
- *val = (int16_t)buff[1];
- *val = (*val * 256) + (int16_t)buff[0];
- return ret;
- }
- /**
- * @brief Angular rate sensor. The value is expressed as a 16-bit word in
- * two’s complement.[get]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that stores data read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_angular_rate_raw_get(stmdev_ctx_t *ctx,
- int16_t *val)
- {
- uint8_t buff[6];
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_OUTX_L_G, buff, 6);
- val[0] = (int16_t)buff[1];
- val[0] = (val[0] * 256) + (int16_t)buff[0];
- val[1] = (int16_t)buff[3];
- val[1] = (val[1] * 256) + (int16_t)buff[2];
- val[2] = (int16_t)buff[5];
- val[2] = (val[2] * 256) + (int16_t)buff[4];
- return ret;
- }
- /**
- * @brief Linear acceleration output register. The value is expressed
- * as a 16-bit word in two’s complement.[get]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that stores data read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_acceleration_raw_get(stmdev_ctx_t *ctx,
- int16_t *val)
- {
- uint8_t buff[6];
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_OUTX_L_XL, buff, 6);
- val[0] = (int16_t)buff[1];
- val[0] = (val[0] * 256) + (int16_t)buff[0];
- val[1] = (int16_t)buff[3];
- val[1] = (val[1] * 256) + (int16_t)buff[2];
- val[2] = (int16_t)buff[5];
- val[2] = (val[2] * 256) + (int16_t)buff[4];
- return ret;
- }
- /**
- * @brief External magnetometer raw data.[get]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that stores data read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_mag_calibrated_raw_get(stmdev_ctx_t *ctx,
- int16_t *val)
- {
- uint8_t buff[6];
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_OUT_MAG_RAW_X_L, buff, 6);
- val[0] = (int16_t)buff[1];
- val[0] = (val[0] * 256) + (int16_t)buff[0];
- val[1] = (int16_t)buff[3];
- val[1] = (val[1] * 256) + (int16_t)buff[2];
- val[2] = (int16_t)buff[5];
- val[2] = (val[2] * 256) + (int16_t)buff[4];
- return ret;
- }
- /**
- * @brief Read data in FIFO.[get]
- *
- * @param ctx Read / write interface definitions
- * @param buffer Data buffer to store FIFO data.
- * @param len Number of data to read from FIFO.
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_raw_data_get(stmdev_ctx_t *ctx,
- uint8_t *buffer,
- uint8_t len)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_DATA_OUT_L, buffer,
- len);
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_common
- * @brief This section groups common useful functions.
- * @{
- *
- */
- /**
- * @brief Enable access to the embedded functions/sensor hub
- * configuration registers[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of func_cfg_en in reg FUNC_CFG_ACCESS
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_mem_bank_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_func_cfg_en_t val)
- {
- lsm6ds3tr_c_func_cfg_access_t func_cfg_access;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FUNC_CFG_ACCESS,
- (uint8_t *)&func_cfg_access, 1);
- if (ret == 0)
- {
- func_cfg_access.func_cfg_en = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FUNC_CFG_ACCESS,
- (uint8_t *)&func_cfg_access, 1);
- }
- return ret;
- }
- /**
- * @brief Enable access to the embedded functions/sensor hub configuration
- * registers[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of func_cfg_en in reg FUNC_CFG_ACCESS
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_mem_bank_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_func_cfg_en_t *val)
- {
- lsm6ds3tr_c_func_cfg_access_t func_cfg_access;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FUNC_CFG_ACCESS,
- (uint8_t *)&func_cfg_access, 1);
- switch (func_cfg_access.func_cfg_en)
- {
- case LSM6DS3TR_C_USER_BANK:
- *val = LSM6DS3TR_C_USER_BANK;
- break;
- case LSM6DS3TR_C_BANK_B:
- *val = LSM6DS3TR_C_BANK_B;
- break;
- default:
- *val = LSM6DS3TR_C_BANK_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Data-ready pulsed / letched mode[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of drdy_pulsed in reg DRDY_PULSE_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_data_ready_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_drdy_pulsed_g_t val)
- {
- lsm6ds3tr_c_drdy_pulse_cfg_g_t drdy_pulse_cfg_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_DRDY_PULSE_CFG_G,
- (uint8_t *)&drdy_pulse_cfg_g, 1);
- if (ret == 0)
- {
- drdy_pulse_cfg_g.drdy_pulsed = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_DRDY_PULSE_CFG_G,
- (uint8_t *)&drdy_pulse_cfg_g, 1);
- }
- return ret;
- }
- /**
- * @brief Data-ready pulsed / letched mode[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of drdy_pulsed in reg DRDY_PULSE_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_data_ready_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_drdy_pulsed_g_t *val)
- {
- lsm6ds3tr_c_drdy_pulse_cfg_g_t drdy_pulse_cfg_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_DRDY_PULSE_CFG_G,
- (uint8_t *)&drdy_pulse_cfg_g, 1);
- switch (drdy_pulse_cfg_g.drdy_pulsed)
- {
- case LSM6DS3TR_C_DRDY_LATCHED:
- *val = LSM6DS3TR_C_DRDY_LATCHED;
- break;
- case LSM6DS3TR_C_DRDY_PULSED:
- *val = LSM6DS3TR_C_DRDY_PULSED;
- break;
- default:
- *val = LSM6DS3TR_C_DRDY_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief DeviceWhoamI.[get]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that stores data read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_device_id_get(stmdev_ctx_t *ctx, uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WHO_AM_I, buff, 1);
- return ret;
- }
- /**
- * @brief Software reset. Restore the default values in user registers[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of sw_reset in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_reset_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- if (ret == 0)
- {
- ctrl3_c.sw_reset = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- }
- return ret;
- }
- /**
- * @brief Software reset. Restore the default values in user registers[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of sw_reset in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_reset_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- *val = ctrl3_c.sw_reset;
- return ret;
- }
- /**
- * @brief Big/Little Endian Data selection.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of ble in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_data_format_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_ble_t val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- if (ret == 0)
- {
- ctrl3_c.ble = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- }
- return ret;
- }
- /**
- * @brief Big/Little Endian Data selection.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of ble in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_data_format_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_ble_t *val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- switch (ctrl3_c.ble)
- {
- case LSM6DS3TR_C_LSB_AT_LOW_ADD:
- *val = LSM6DS3TR_C_LSB_AT_LOW_ADD;
- break;
- case LSM6DS3TR_C_MSB_AT_LOW_ADD:
- *val = LSM6DS3TR_C_MSB_AT_LOW_ADD;
- break;
- default:
- *val = LSM6DS3TR_C_DATA_FMT_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Register address automatically incremented during a multiple byte
- * access with a serial interface.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of if_inc in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_auto_increment_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- if (ret == 0)
- {
- ctrl3_c.if_inc = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- }
- return ret;
- }
- /**
- * @brief Register address automatically incremented during a multiple byte
- * access with a serial interface.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of if_inc in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_auto_increment_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- *val = ctrl3_c.if_inc;
- return ret;
- }
- /**
- * @brief Reboot memory content. Reload the calibration parameters.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of boot in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_boot_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- if (ret == 0)
- {
- ctrl3_c.boot = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- }
- return ret;
- }
- /**
- * @brief Reboot memory content. Reload the calibration parameters.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of boot in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_boot_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- *val = ctrl3_c.boot;
- return ret;
- }
- /**
- * @brief Linear acceleration sensor self-test enable.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of st_xl in reg CTRL5_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_self_test_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_st_xl_t val)
- {
- lsm6ds3tr_c_ctrl5_c_t ctrl5_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL5_C,
- (uint8_t *)&ctrl5_c, 1);
- if (ret == 0)
- {
- ctrl5_c.st_xl = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL5_C,
- (uint8_t *)&ctrl5_c, 1);
- }
- return ret;
- }
- /**
- * @brief Linear acceleration sensor self-test enable.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of st_xl in reg CTRL5_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_self_test_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_st_xl_t *val)
- {
- lsm6ds3tr_c_ctrl5_c_t ctrl5_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL5_C,
- (uint8_t *)&ctrl5_c, 1);
- switch (ctrl5_c.st_xl)
- {
- case LSM6DS3TR_C_XL_ST_DISABLE:
- *val = LSM6DS3TR_C_XL_ST_DISABLE;
- break;
- case LSM6DS3TR_C_XL_ST_POSITIVE:
- *val = LSM6DS3TR_C_XL_ST_POSITIVE;
- break;
- case LSM6DS3TR_C_XL_ST_NEGATIVE:
- *val = LSM6DS3TR_C_XL_ST_NEGATIVE;
- break;
- default:
- *val = LSM6DS3TR_C_XL_ST_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Angular rate sensor self-test enable.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of st_g in reg CTRL5_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_self_test_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_st_g_t val)
- {
- lsm6ds3tr_c_ctrl5_c_t ctrl5_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL5_C,
- (uint8_t *)&ctrl5_c, 1);
- if (ret == 0)
- {
- ctrl5_c.st_g = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL5_C,
- (uint8_t *)&ctrl5_c, 1);
- }
- return ret;
- }
- /**
- * @brief Angular rate sensor self-test enable.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of st_g in reg CTRL5_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_self_test_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_st_g_t *val)
- {
- lsm6ds3tr_c_ctrl5_c_t ctrl5_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL5_C,
- (uint8_t *)&ctrl5_c, 1);
- switch (ctrl5_c.st_g)
- {
- case LSM6DS3TR_C_GY_ST_DISABLE:
- *val = LSM6DS3TR_C_GY_ST_DISABLE;
- break;
- case LSM6DS3TR_C_GY_ST_POSITIVE:
- *val = LSM6DS3TR_C_GY_ST_POSITIVE;
- break;
- case LSM6DS3TR_C_GY_ST_NEGATIVE:
- *val = LSM6DS3TR_C_GY_ST_NEGATIVE;
- break;
- default:
- *val = LSM6DS3TR_C_GY_ST_ND;
- break;
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_filters
- * @brief This section group all the functions concerning the filters
- * configuration that impact both accelerometer and gyro.
- * @{
- *
- */
- /**
- * @brief Mask DRDY on pin (both XL & Gyro) until filter settling ends
- * (XL and Gyro independently masked).[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of drdy_mask in reg CTRL4_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_filter_settling_mask_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- if (ret == 0)
- {
- ctrl4_c.drdy_mask = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- }
- return ret;
- }
- /**
- * @brief Mask DRDY on pin (both XL & Gyro) until filter settling ends
- * (XL and Gyro independently masked).[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of drdy_mask in reg CTRL4_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_filter_settling_mask_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- *val = ctrl4_c.drdy_mask;
- return ret;
- }
- /**
- * @brief HPF or SLOPE filter selection on wake-up and Activity/Inactivity
- * functions.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of slope_fds in reg TAP_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_hp_path_internal_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_slope_fds_t val)
- {
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- if (ret == 0)
- {
- tap_cfg.slope_fds = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- }
- return ret;
- }
- /**
- * @brief HPF or SLOPE filter selection on wake-up and Activity/Inactivity
- * functions.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of slope_fds in reg TAP_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_hp_path_internal_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_slope_fds_t *val)
- {
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- switch (tap_cfg.slope_fds)
- {
- case LSM6DS3TR_C_USE_SLOPE:
- *val = LSM6DS3TR_C_USE_SLOPE;
- break;
- case LSM6DS3TR_C_USE_HPF:
- *val = LSM6DS3TR_C_USE_HPF;
- break;
- default:
- *val = LSM6DS3TR_C_HP_PATH_ND;
- break;
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_accelerometer_filters
- * @brief This section group all the functions concerning the filters
- * configuration that impact accelerometer in every mode.
- * @{
- *
- */
- /**
- * @brief Accelerometer analog chain bandwidth selection (only for
- * accelerometer ODR ≥ 1.67 kHz).[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of bw0_xl in reg CTRL1_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_filter_analog_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_bw0_xl_t val)
- {
- lsm6ds3tr_c_ctrl1_xl_t ctrl1_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL1_XL,
- (uint8_t *)&ctrl1_xl, 1);
- if (ret == 0)
- {
- ctrl1_xl.bw0_xl = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL1_XL,
- (uint8_t *)&ctrl1_xl, 1);
- }
- return ret;
- }
- /**
- * @brief Accelerometer analog chain bandwidth selection (only for
- * accelerometer ODR ≥ 1.67 kHz).[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of bw0_xl in reg CTRL1_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_filter_analog_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_bw0_xl_t *val)
- {
- lsm6ds3tr_c_ctrl1_xl_t ctrl1_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL1_XL,
- (uint8_t *)&ctrl1_xl, 1);
- switch (ctrl1_xl.bw0_xl)
- {
- case LSM6DS3TR_C_XL_ANA_BW_1k5Hz:
- *val = LSM6DS3TR_C_XL_ANA_BW_1k5Hz;
- break;
- case LSM6DS3TR_C_XL_ANA_BW_400Hz:
- *val = LSM6DS3TR_C_XL_ANA_BW_400Hz;
- break;
- default:
- *val = LSM6DS3TR_C_XL_ANA_BW_ND;
- break;
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_accelerometer_filters
- * @brief This section group all the functions concerning the filters
- * configuration that impact accelerometer.
- * @{
- *
- */
- /**
- * @brief Accelerometer digital LPF (LPF1) bandwidth selection LPF2 is
- * not used.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of lpf1_bw_sel in reg CTRL1_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_lp1_bandwidth_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_lpf1_bw_sel_t val)
- {
- lsm6ds3tr_c_ctrl1_xl_t ctrl1_xl;
- lsm6ds3tr_c_ctrl8_xl_t ctrl8_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL1_XL,
- (uint8_t *)&ctrl1_xl, 1);
- if (ret == 0)
- {
- ctrl1_xl.lpf1_bw_sel = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL1_XL,
- (uint8_t *)&ctrl1_xl, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- if (ret == 0)
- {
- ctrl8_xl.lpf2_xl_en = 0;
- ctrl8_xl.hp_slope_xl_en = 0;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Accelerometer digital LPF (LPF1) bandwidth selection LPF2
- * is not used.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of lpf1_bw_sel in reg CTRL1_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_lp1_bandwidth_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_lpf1_bw_sel_t *val)
- {
- lsm6ds3tr_c_ctrl1_xl_t ctrl1_xl;
- lsm6ds3tr_c_ctrl8_xl_t ctrl8_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- if (ret == 0)
- {
- if ((ctrl8_xl.lpf2_xl_en != 0x00U) ||
- (ctrl8_xl.hp_slope_xl_en != 0x00U))
- {
- *val = LSM6DS3TR_C_XL_LP1_NA;
- }
- else
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL1_XL,
- (uint8_t *)&ctrl1_xl, 1);
- switch (ctrl1_xl.lpf1_bw_sel)
- {
- case LSM6DS3TR_C_XL_LP1_ODR_DIV_2:
- *val = LSM6DS3TR_C_XL_LP1_ODR_DIV_2;
- break;
- case LSM6DS3TR_C_XL_LP1_ODR_DIV_4:
- *val = LSM6DS3TR_C_XL_LP1_ODR_DIV_4;
- break;
- default:
- *val = LSM6DS3TR_C_XL_LP1_NA;
- break;
- }
- }
- }
- return ret;
- }
- /**
- * @brief LPF2 on outputs[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of input_composite in reg CTRL8_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_lp2_bandwidth_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_input_composite_t val)
- {
- lsm6ds3tr_c_ctrl8_xl_t ctrl8_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- if (ret == 0)
- {
- ctrl8_xl.input_composite = ((uint8_t) val & 0x10U) >> 4;
- ctrl8_xl.hpcf_xl = (uint8_t) val & 0x03U;
- ctrl8_xl.lpf2_xl_en = 1;
- ctrl8_xl.hp_slope_xl_en = 0;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- }
- return ret;
- }
- /**
- * @brief LPF2 on outputs[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of input_composite in reg CTRL8_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_lp2_bandwidth_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_input_composite_t *val)
- {
- lsm6ds3tr_c_ctrl8_xl_t ctrl8_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- if (ret == 0)
- {
- if ((ctrl8_xl.lpf2_xl_en == 0x00U) ||
- (ctrl8_xl.hp_slope_xl_en != 0x00U))
- {
- *val = LSM6DS3TR_C_XL_LP_NA;
- }
- else
- {
- switch ((ctrl8_xl.input_composite << 4) + ctrl8_xl.hpcf_xl)
- {
- case LSM6DS3TR_C_XL_LOW_LAT_LP_ODR_DIV_50:
- *val = LSM6DS3TR_C_XL_LOW_LAT_LP_ODR_DIV_50;
- break;
- case LSM6DS3TR_C_XL_LOW_LAT_LP_ODR_DIV_100:
- *val = LSM6DS3TR_C_XL_LOW_LAT_LP_ODR_DIV_100;
- break;
- case LSM6DS3TR_C_XL_LOW_LAT_LP_ODR_DIV_9:
- *val = LSM6DS3TR_C_XL_LOW_LAT_LP_ODR_DIV_9;
- break;
- case LSM6DS3TR_C_XL_LOW_LAT_LP_ODR_DIV_400:
- *val = LSM6DS3TR_C_XL_LOW_LAT_LP_ODR_DIV_400;
- break;
- case LSM6DS3TR_C_XL_LOW_NOISE_LP_ODR_DIV_50:
- *val = LSM6DS3TR_C_XL_LOW_NOISE_LP_ODR_DIV_50;
- break;
- case LSM6DS3TR_C_XL_LOW_NOISE_LP_ODR_DIV_100:
- *val = LSM6DS3TR_C_XL_LOW_NOISE_LP_ODR_DIV_100;
- break;
- case LSM6DS3TR_C_XL_LOW_NOISE_LP_ODR_DIV_9:
- *val = LSM6DS3TR_C_XL_LOW_NOISE_LP_ODR_DIV_9;
- break;
- case LSM6DS3TR_C_XL_LOW_NOISE_LP_ODR_DIV_400:
- *val = LSM6DS3TR_C_XL_LOW_NOISE_LP_ODR_DIV_400;
- break;
- default:
- *val = LSM6DS3TR_C_XL_LP_NA;
- break;
- }
- }
- }
- return ret;
- }
- /**
- * @brief Enable HP filter reference mode.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of hp_ref_mode in reg CTRL8_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_reference_mode_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_ctrl8_xl_t ctrl8_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- if (ret == 0)
- {
- ctrl8_xl.hp_ref_mode = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- }
- return ret;
- }
- /**
- * @brief Enable HP filter reference mode.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of hp_ref_mode in reg CTRL8_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_reference_mode_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_ctrl8_xl_t ctrl8_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- *val = ctrl8_xl.hp_ref_mode;
- return ret;
- }
- /**
- * @brief High pass/Slope on outputs.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of hpcf_xl in reg CTRL8_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_hp_bandwidth_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_hpcf_xl_t val)
- {
- lsm6ds3tr_c_ctrl8_xl_t ctrl8_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- if (ret == 0)
- {
- ctrl8_xl.input_composite = 0;
- ctrl8_xl.hpcf_xl = (uint8_t)val & 0x03U;
- ctrl8_xl.hp_slope_xl_en = 1;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- }
- return ret;
- }
- /**
- * @brief High pass/Slope on outputs.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of hpcf_xl in reg CTRL8_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_xl_hp_bandwidth_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_hpcf_xl_t *val)
- {
- lsm6ds3tr_c_ctrl8_xl_t ctrl8_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- if (ctrl8_xl.hp_slope_xl_en == 0x00U)
- {
- *val = LSM6DS3TR_C_XL_HP_NA;
- }
- switch (ctrl8_xl.hpcf_xl)
- {
- case LSM6DS3TR_C_XL_HP_ODR_DIV_4:
- *val = LSM6DS3TR_C_XL_HP_ODR_DIV_4;
- break;
- case LSM6DS3TR_C_XL_HP_ODR_DIV_100:
- *val = LSM6DS3TR_C_XL_HP_ODR_DIV_100;
- break;
- case LSM6DS3TR_C_XL_HP_ODR_DIV_9:
- *val = LSM6DS3TR_C_XL_HP_ODR_DIV_9;
- break;
- case LSM6DS3TR_C_XL_HP_ODR_DIV_400:
- *val = LSM6DS3TR_C_XL_HP_ODR_DIV_400;
- break;
- default:
- *val = LSM6DS3TR_C_XL_HP_NA;
- break;
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_gyroscope_filters
- * @brief This section group all the functions concerning the filters
- * configuration that impact gyroscope.
- * @{
- *
- */
- /**
- * @brief Gyroscope low pass path bandwidth.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val gyroscope filtering chain configuration.
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_band_pass_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_lpf1_sel_g_t val)
- {
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- lsm6ds3tr_c_ctrl6_c_t ctrl6_c;
- lsm6ds3tr_c_ctrl7_g_t ctrl7_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL7_G,
- (uint8_t *)&ctrl7_g, 1);
- if (ret == 0)
- {
- ctrl7_g.hpm_g = ((uint8_t)val & 0x30U) >> 4;
- ctrl7_g.hp_en_g = ((uint8_t)val & 0x80U) >> 7;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL7_G,
- (uint8_t *)&ctrl7_g, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL6_C,
- (uint8_t *)&ctrl6_c, 1);
- if (ret == 0)
- {
- ctrl6_c.ftype = (uint8_t)val & 0x03U;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL6_C,
- (uint8_t *)&ctrl6_c, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- if (ret == 0)
- {
- ctrl4_c.lpf1_sel_g = ((uint8_t)val & 0x08U) >> 3;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- }
- }
- }
- }
- }
- return ret;
- }
- /**
- * @brief Gyroscope low pass path bandwidth.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val gyroscope filtering chain
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_band_pass_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_lpf1_sel_g_t *val)
- {
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- lsm6ds3tr_c_ctrl6_c_t ctrl6_c;
- lsm6ds3tr_c_ctrl7_g_t ctrl7_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL6_C,
- (uint8_t *)&ctrl6_c, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL7_G,
- (uint8_t *)&ctrl7_g, 1);
- switch ((ctrl7_g.hp_en_g << 7) + (ctrl7_g.hpm_g << 4) +
- (ctrl4_c.lpf1_sel_g << 3) + ctrl6_c.ftype)
- {
- case LSM6DS3TR_C_HP_16mHz_LP2:
- *val = LSM6DS3TR_C_HP_16mHz_LP2;
- break;
- case LSM6DS3TR_C_HP_65mHz_LP2:
- *val = LSM6DS3TR_C_HP_65mHz_LP2;
- break;
- case LSM6DS3TR_C_HP_260mHz_LP2:
- *val = LSM6DS3TR_C_HP_260mHz_LP2;
- break;
- case LSM6DS3TR_C_HP_1Hz04_LP2:
- *val = LSM6DS3TR_C_HP_1Hz04_LP2;
- break;
- case LSM6DS3TR_C_HP_DISABLE_LP1_LIGHT:
- *val = LSM6DS3TR_C_HP_DISABLE_LP1_LIGHT;
- break;
- case LSM6DS3TR_C_HP_DISABLE_LP1_NORMAL:
- *val = LSM6DS3TR_C_HP_DISABLE_LP1_NORMAL;
- break;
- case LSM6DS3TR_C_HP_DISABLE_LP_STRONG:
- *val = LSM6DS3TR_C_HP_DISABLE_LP_STRONG;
- break;
- case LSM6DS3TR_C_HP_DISABLE_LP1_AGGRESSIVE:
- *val = LSM6DS3TR_C_HP_DISABLE_LP1_AGGRESSIVE;
- break;
- case LSM6DS3TR_C_HP_16mHz_LP1_LIGHT:
- *val = LSM6DS3TR_C_HP_16mHz_LP1_LIGHT;
- break;
- case LSM6DS3TR_C_HP_65mHz_LP1_NORMAL:
- *val = LSM6DS3TR_C_HP_65mHz_LP1_NORMAL;
- break;
- case LSM6DS3TR_C_HP_260mHz_LP1_STRONG:
- *val = LSM6DS3TR_C_HP_260mHz_LP1_STRONG;
- break;
- case LSM6DS3TR_C_HP_1Hz04_LP1_AGGRESSIVE:
- *val = LSM6DS3TR_C_HP_1Hz04_LP1_AGGRESSIVE;
- break;
- default:
- *val = LSM6DS3TR_C_HP_GY_BAND_NA;
- break;
- }
- }
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_serial_interface
- * @brief This section groups all the functions concerning serial
- * interface management
- * @{
- *
- */
- /**
- * @brief SPI Serial Interface Mode selection.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of sim in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_spi_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_sim_t val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- if (ret == 0)
- {
- ctrl3_c.sim = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- }
- return ret;
- }
- /**
- * @brief SPI Serial Interface Mode selection.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of sim in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_spi_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_sim_t *val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- switch (ctrl3_c.sim)
- {
- case LSM6DS3TR_C_SPI_4_WIRE:
- *val = LSM6DS3TR_C_SPI_4_WIRE;
- break;
- case LSM6DS3TR_C_SPI_3_WIRE:
- *val = LSM6DS3TR_C_SPI_3_WIRE;
- break;
- default:
- *val = LSM6DS3TR_C_SPI_MODE_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Disable / Enable I2C interface.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of i2c_disable in reg CTRL4_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_i2c_interface_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_i2c_disable_t val)
- {
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- if (ret == 0)
- {
- ctrl4_c.i2c_disable = (uint8_t)val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- }
- return ret;
- }
- /**
- * @brief Disable / Enable I2C interface.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of i2c_disable in reg CTRL4_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_i2c_interface_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_i2c_disable_t *val)
- {
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- switch (ctrl4_c.i2c_disable)
- {
- case LSM6DS3TR_C_I2C_ENABLE:
- *val = LSM6DS3TR_C_I2C_ENABLE;
- break;
- case LSM6DS3TR_C_I2C_DISABLE:
- *val = LSM6DS3TR_C_I2C_DISABLE;
- break;
- default:
- *val = LSM6DS3TR_C_I2C_MODE_ND;
- break;
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_interrupt_pins
- * @brief This section groups all the functions that manage
- * interrupt pins
- * @{
- *
- */
- /**
- * @brief Select the signal that need to route on int1 pad[set]
- *
- * @param ctx Read / write interface definitions
- * @param val configure INT1_CTRL, MD1_CFG, CTRL4_C(den_drdy_int1),
- * MASTER_CONFIG(drdy_on_int1)
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pin_int1_route_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_int1_route_t val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- lsm6ds3tr_c_int1_ctrl_t int1_ctrl;
- lsm6ds3tr_c_md1_cfg_t md1_cfg;
- lsm6ds3tr_c_md2_cfg_t md2_cfg;
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_INT1_CTRL,
- (uint8_t *)&int1_ctrl, 1);
- if (ret == 0)
- {
- int1_ctrl.int1_drdy_xl = val.int1_drdy_xl;
- int1_ctrl.int1_drdy_g = val.int1_drdy_g;
- int1_ctrl.int1_boot = val.int1_boot;
- int1_ctrl.int1_fth = val.int1_fth;
- int1_ctrl.int1_fifo_ovr = val.int1_fifo_ovr;
- int1_ctrl.int1_full_flag = val.int1_full_flag;
- int1_ctrl.int1_sign_mot = val.int1_sign_mot;
- int1_ctrl.int1_step_detector = val.int1_step_detector;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_INT1_CTRL,
- (uint8_t *)&int1_ctrl, 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MD1_CFG,
- (uint8_t *)&md1_cfg, 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MD2_CFG,
- (uint8_t *)&md2_cfg, 1);
- }
- if (ret == 0)
- {
- md1_cfg.int1_timer = val.int1_timer;
- md1_cfg.int1_tilt = val.int1_tilt;
- md1_cfg.int1_6d = val.int1_6d;
- md1_cfg.int1_double_tap = val.int1_double_tap;
- md1_cfg.int1_ff = val.int1_ff;
- md1_cfg.int1_wu = val.int1_wu;
- md1_cfg.int1_single_tap = val.int1_single_tap;
- md1_cfg.int1_inact_state = val.int1_inact_state;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MD1_CFG,
- (uint8_t *)&md1_cfg, 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- }
- if (ret == 0)
- {
- ctrl4_c.den_drdy_int1 = val.den_drdy_int1;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- }
- if (ret == 0)
- {
- master_config.drdy_on_int1 = val.den_drdy_int1;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- if ((val.int1_6d != 0x00U) ||
- (val.int1_ff != 0x00U) ||
- (val.int1_wu != 0x00U) ||
- (val.int1_single_tap != 0x00U) ||
- (val.int1_double_tap != 0x00U) ||
- (val.int1_inact_state != 0x00U) ||
- (md2_cfg.int2_6d != 0x00U) ||
- (md2_cfg.int2_ff != 0x00U) ||
- (md2_cfg.int2_wu != 0x00U) ||
- (md2_cfg.int2_single_tap != 0x00U) ||
- (md2_cfg.int2_double_tap != 0x00U) ||
- (md2_cfg.int2_inact_state != 0x00U))
- {
- tap_cfg.interrupts_enable = PROPERTY_ENABLE;
- }
- else
- {
- tap_cfg.interrupts_enable = PROPERTY_DISABLE;
- }
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- }
- return ret;
- }
- /**
- * @brief Select the signal that need to route on int1 pad[get]
- *
- * @param ctx Read / write interface definitions
- * @param val read INT1_CTRL, MD1_CFG, CTRL4_C(den_drdy_int1),
- * MASTER_CONFIG(drdy_on_int1)
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pin_int1_route_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_int1_route_t *val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- lsm6ds3tr_c_int1_ctrl_t int1_ctrl;
- lsm6ds3tr_c_md1_cfg_t md1_cfg;
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_INT1_CTRL,
- (uint8_t *)&int1_ctrl, 1);
- if (ret == 0)
- {
- val->int1_drdy_xl = int1_ctrl.int1_drdy_xl;
- val->int1_drdy_g = int1_ctrl.int1_drdy_g;
- val->int1_boot = int1_ctrl.int1_boot;
- val->int1_fth = int1_ctrl.int1_fth;
- val->int1_fifo_ovr = int1_ctrl.int1_fifo_ovr;
- val->int1_full_flag = int1_ctrl.int1_full_flag;
- val->int1_sign_mot = int1_ctrl.int1_sign_mot;
- val->int1_step_detector = int1_ctrl.int1_step_detector ;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MD1_CFG,
- (uint8_t *)&md1_cfg, 1);
- if (ret == 0)
- {
- val->int1_timer = md1_cfg.int1_timer;
- val->int1_tilt = md1_cfg.int1_tilt;
- val->int1_6d = md1_cfg.int1_6d;
- val->int1_double_tap = md1_cfg.int1_double_tap;
- val->int1_ff = md1_cfg.int1_ff;
- val->int1_wu = md1_cfg.int1_wu;
- val->int1_single_tap = md1_cfg.int1_single_tap;
- val->int1_inact_state = md1_cfg.int1_inact_state;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- if (ret == 0)
- {
- val->den_drdy_int1 = ctrl4_c.den_drdy_int1;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- val->den_drdy_int1 = master_config.drdy_on_int1;
- }
- }
- }
- return ret;
- }
- /**
- * @brief Select the signal that need to route on int2 pad[set]
- *
- * @param ctx Read / write interface definitions
- * @param val INT2_CTRL, DRDY_PULSE_CFG(int2_wrist_tilt), MD2_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pin_int2_route_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_int2_route_t val)
- {
- lsm6ds3tr_c_int2_ctrl_t int2_ctrl;
- lsm6ds3tr_c_md1_cfg_t md1_cfg;
- lsm6ds3tr_c_md2_cfg_t md2_cfg;
- lsm6ds3tr_c_drdy_pulse_cfg_g_t drdy_pulse_cfg_g;
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_INT2_CTRL,
- (uint8_t *)&int2_ctrl, 1);
- if (ret == 0)
- {
- int2_ctrl.int2_drdy_xl = val.int2_drdy_xl;
- int2_ctrl.int2_drdy_g = val.int2_drdy_g;
- int2_ctrl.int2_drdy_temp = val.int2_drdy_temp;
- int2_ctrl.int2_fth = val.int2_fth;
- int2_ctrl.int2_fifo_ovr = val.int2_fifo_ovr;
- int2_ctrl.int2_full_flag = val.int2_full_flag;
- int2_ctrl.int2_step_count_ov = val.int2_step_count_ov;
- int2_ctrl.int2_step_delta = val.int2_step_delta;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_INT2_CTRL,
- (uint8_t *)&int2_ctrl, 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MD1_CFG,
- (uint8_t *)&md1_cfg, 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MD2_CFG,
- (uint8_t *)&md2_cfg, 1);
- }
- if (ret == 0)
- {
- md2_cfg.int2_iron = val.int2_iron;
- md2_cfg.int2_tilt = val.int2_tilt;
- md2_cfg.int2_6d = val.int2_6d;
- md2_cfg.int2_double_tap = val.int2_double_tap;
- md2_cfg.int2_ff = val.int2_ff;
- md2_cfg.int2_wu = val.int2_wu;
- md2_cfg.int2_single_tap = val.int2_single_tap;
- md2_cfg.int2_inact_state = val.int2_inact_state;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MD2_CFG,
- (uint8_t *)&md2_cfg, 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_DRDY_PULSE_CFG_G,
- (uint8_t *)&drdy_pulse_cfg_g, 1);
- }
- if (ret == 0)
- {
- drdy_pulse_cfg_g.int2_wrist_tilt = val.int2_wrist_tilt;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_DRDY_PULSE_CFG_G,
- (uint8_t *)&drdy_pulse_cfg_g, 1);
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- if ((md1_cfg.int1_6d != 0x00U) ||
- (md1_cfg.int1_ff != 0x00U) ||
- (md1_cfg.int1_wu != 0x00U) ||
- (md1_cfg.int1_single_tap != 0x00U) ||
- (md1_cfg.int1_double_tap != 0x00U) ||
- (md1_cfg.int1_inact_state != 0x00U) ||
- (val.int2_6d != 0x00U) ||
- (val.int2_ff != 0x00U) ||
- (val.int2_wu != 0x00U) ||
- (val.int2_single_tap != 0x00U) ||
- (val.int2_double_tap != 0x00U) ||
- (val.int2_inact_state != 0x00U))
- {
- tap_cfg.interrupts_enable = PROPERTY_ENABLE;
- }
- else
- {
- tap_cfg.interrupts_enable = PROPERTY_DISABLE;
- }
- }
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- }
- return ret;
- }
- /**
- * @brief Select the signal that need to route on int2 pad[get]
- *
- * @param ctx Read / write interface definitions
- * @param val INT2_CTRL, DRDY_PULSE_CFG(int2_wrist_tilt), MD2_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pin_int2_route_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_int2_route_t *val)
- {
- lsm6ds3tr_c_int2_ctrl_t int2_ctrl;
- lsm6ds3tr_c_md2_cfg_t md2_cfg;
- lsm6ds3tr_c_drdy_pulse_cfg_g_t drdy_pulse_cfg_g;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_INT2_CTRL,
- (uint8_t *)&int2_ctrl, 1);
- if (ret == 0)
- {
- val->int2_drdy_xl = int2_ctrl.int2_drdy_xl;
- val->int2_drdy_g = int2_ctrl.int2_drdy_g;
- val->int2_drdy_temp = int2_ctrl.int2_drdy_temp;
- val->int2_fth = int2_ctrl.int2_fth;
- val->int2_fifo_ovr = int2_ctrl.int2_fifo_ovr;
- val->int2_full_flag = int2_ctrl.int2_full_flag;
- val->int2_step_count_ov = int2_ctrl.int2_step_count_ov;
- val->int2_step_delta = int2_ctrl.int2_step_delta;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MD2_CFG,
- (uint8_t *)&md2_cfg, 1);
- if (ret == 0)
- {
- val->int2_iron = md2_cfg.int2_iron;
- val->int2_tilt = md2_cfg.int2_tilt;
- val->int2_6d = md2_cfg.int2_6d;
- val->int2_double_tap = md2_cfg.int2_double_tap;
- val->int2_ff = md2_cfg.int2_ff;
- val->int2_wu = md2_cfg.int2_wu;
- val->int2_single_tap = md2_cfg.int2_single_tap;
- val->int2_inact_state = md2_cfg.int2_inact_state;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_DRDY_PULSE_CFG_G,
- (uint8_t *)&drdy_pulse_cfg_g, 1);
- val->int2_wrist_tilt = drdy_pulse_cfg_g.int2_wrist_tilt;
- }
- }
- return ret;
- }
- /**
- * @brief Push-pull/open drain selection on interrupt pads.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of pp_od in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pin_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_pp_od_t val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- if (ret == 0)
- {
- ctrl3_c.pp_od = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- }
- return ret;
- }
- /**
- * @brief Push-pull/open drain selection on interrupt pads.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of pp_od in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pin_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_pp_od_t *val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- switch (ctrl3_c.pp_od)
- {
- case LSM6DS3TR_C_PUSH_PULL:
- *val = LSM6DS3TR_C_PUSH_PULL;
- break;
- case LSM6DS3TR_C_OPEN_DRAIN:
- *val = LSM6DS3TR_C_OPEN_DRAIN;
- break;
- default:
- *val = LSM6DS3TR_C_PIN_MODE_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Interrupt active-high/low.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of h_lactive in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pin_polarity_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_h_lactive_t val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- if (ret == 0)
- {
- ctrl3_c.h_lactive = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- }
- return ret;
- }
- /**
- * @brief Interrupt active-high/low.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of h_lactive in reg CTRL3_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pin_polarity_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_h_lactive_t *val)
- {
- lsm6ds3tr_c_ctrl3_c_t ctrl3_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL3_C,
- (uint8_t *)&ctrl3_c, 1);
- switch (ctrl3_c.h_lactive)
- {
- case LSM6DS3TR_C_ACTIVE_HIGH:
- *val = LSM6DS3TR_C_ACTIVE_HIGH;
- break;
- case LSM6DS3TR_C_ACTIVE_LOW:
- *val = LSM6DS3TR_C_ACTIVE_LOW;
- break;
- default:
- *val = LSM6DS3TR_C_POLARITY_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief All interrupt signals become available on INT1 pin.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of int2_on_int1 in reg CTRL4_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_all_on_int1_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- if (ret == 0)
- {
- ctrl4_c.int2_on_int1 = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- }
- return ret;
- }
- /**
- * @brief All interrupt signals become available on INT1 pin.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of int2_on_int1 in reg CTRL4_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_all_on_int1_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- *val = ctrl4_c.int2_on_int1;
- return ret;
- }
- /**
- * @brief Latched/pulsed interrupt.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of lir in reg TAP_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_int_notification_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_lir_t val)
- {
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- if (ret == 0)
- {
- tap_cfg.lir = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- }
- return ret;
- }
- /**
- * @brief Latched/pulsed interrupt.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of lir in reg TAP_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_int_notification_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_lir_t *val)
- {
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- switch (tap_cfg.lir)
- {
- case LSM6DS3TR_C_INT_PULSED:
- *val = LSM6DS3TR_C_INT_PULSED;
- break;
- case LSM6DS3TR_C_INT_LATCHED:
- *val = LSM6DS3TR_C_INT_LATCHED;
- break;
- default:
- *val = LSM6DS3TR_C_INT_MODE;
- break;
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_Wake_Up_event
- * @brief This section groups all the functions that manage the
- * Wake Up event generation.
- * @{
- *
- */
- /**
- * @brief Threshold for wakeup.1 LSB = FS_XL / 64.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of wk_ths in reg WAKE_UP_THS
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_wkup_threshold_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_wake_up_ths_t wake_up_ths;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_THS,
- (uint8_t *)&wake_up_ths, 1);
- if (ret == 0)
- {
- wake_up_ths.wk_ths = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_WAKE_UP_THS,
- (uint8_t *)&wake_up_ths, 1);
- }
- return ret;
- }
- /**
- * @brief Threshold for wakeup.1 LSB = FS_XL / 64.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of wk_ths in reg WAKE_UP_THS
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_wkup_threshold_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_wake_up_ths_t wake_up_ths;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_THS,
- (uint8_t *)&wake_up_ths, 1);
- *val = wake_up_ths.wk_ths;
- return ret;
- }
- /**
- * @brief Wake up duration event.1LSb = 1 / ODR[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of wake_dur in reg WAKE_UP_DUR
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_wkup_dur_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_wake_up_dur_t wake_up_dur;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_DUR,
- (uint8_t *)&wake_up_dur, 1);
- if (ret == 0)
- {
- wake_up_dur.wake_dur = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_WAKE_UP_DUR,
- (uint8_t *)&wake_up_dur, 1);
- }
- return ret;
- }
- /**
- * @brief Wake up duration event.1LSb = 1 / ODR[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of wake_dur in reg WAKE_UP_DUR
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_wkup_dur_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_wake_up_dur_t wake_up_dur;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_DUR,
- (uint8_t *)&wake_up_dur, 1);
- *val = wake_up_dur.wake_dur;
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_Activity/Inactivity_detection
- * @brief This section groups all the functions concerning
- * activity/inactivity detection.
- * @{
- *
- */
- /**
- * @brief Enables gyroscope Sleep mode.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of sleep in reg CTRL4_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_sleep_mode_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- if (ret == 0)
- {
- ctrl4_c.sleep = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- }
- return ret;
- }
- /**
- * @brief Enables gyroscope Sleep mode.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of sleep in reg CTRL4_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_gy_sleep_mode_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- *val = ctrl4_c.sleep;
- return ret;
- }
- /**
- * @brief Enable inactivity function.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of inact_en in reg TAP_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_act_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_inact_en_t val)
- {
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- if (ret == 0)
- {
- tap_cfg.inact_en = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- }
- return ret;
- }
- /**
- * @brief Enable inactivity function.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of inact_en in reg TAP_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_act_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_inact_en_t *val)
- {
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- switch (tap_cfg.inact_en)
- {
- case LSM6DS3TR_C_PROPERTY_DISABLE:
- *val = LSM6DS3TR_C_PROPERTY_DISABLE;
- break;
- case LSM6DS3TR_C_XL_12Hz5_GY_NOT_AFFECTED:
- *val = LSM6DS3TR_C_XL_12Hz5_GY_NOT_AFFECTED;
- break;
- case LSM6DS3TR_C_XL_12Hz5_GY_SLEEP:
- *val = LSM6DS3TR_C_XL_12Hz5_GY_SLEEP;
- break;
- case LSM6DS3TR_C_XL_12Hz5_GY_PD:
- *val = LSM6DS3TR_C_XL_12Hz5_GY_PD;
- break;
- default:
- *val = LSM6DS3TR_C_ACT_MODE_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Duration to go in sleep mode.1 LSb = 512 / ODR[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of sleep_dur in reg WAKE_UP_DUR
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_act_sleep_dur_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_wake_up_dur_t wake_up_dur;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_DUR,
- (uint8_t *)&wake_up_dur, 1);
- if (ret == 0)
- {
- wake_up_dur.sleep_dur = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_WAKE_UP_DUR,
- (uint8_t *)&wake_up_dur, 1);
- }
- return ret;
- }
- /**
- * @brief Duration to go in sleep mode. 1 LSb = 512 / ODR[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of sleep_dur in reg WAKE_UP_DUR
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_act_sleep_dur_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_wake_up_dur_t wake_up_dur;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_DUR,
- (uint8_t *)&wake_up_dur, 1);
- *val = wake_up_dur.sleep_dur;
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_tap_generator
- * @brief This section groups all the functions that manage the
- * tap and double tap event generation.
- * @{
- *
- */
- /**
- * @brief Read the tap / double tap source register.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Structure of registers from TAP_SRC
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_src_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_tap_src_t *val)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_SRC, (uint8_t *) val, 1);
- return ret;
- }
- /**
- * @brief Enable Z direction in tap recognition.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tap_z_en in reg TAP_CFG
- *
- */
- int32_t lsm6ds3tr_c_tap_detection_on_z_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- if (ret == 0)
- {
- tap_cfg.tap_z_en = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- }
- return ret;
- }
- /**
- * @brief Enable Z direction in tap recognition.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tap_z_en in reg TAP_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_detection_on_z_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- *val = tap_cfg.tap_z_en;
- return ret;
- }
- /**
- * @brief Enable Y direction in tap recognition.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tap_y_en in reg TAP_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_detection_on_y_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- if (ret == 0)
- {
- tap_cfg.tap_y_en = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- }
- return ret;
- }
- /**
- * @brief Enable Y direction in tap recognition.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tap_y_en in reg TAP_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_detection_on_y_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- *val = tap_cfg.tap_y_en;
- return ret;
- }
- /**
- * @brief Enable X direction in tap recognition.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tap_x_en in reg TAP_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_detection_on_x_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- if (ret == 0)
- {
- tap_cfg.tap_x_en = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- }
- return ret;
- }
- /**
- * @brief Enable X direction in tap recognition.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tap_x_en in reg TAP_CFG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_detection_on_x_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_tap_cfg_t tap_cfg;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_CFG,
- (uint8_t *)&tap_cfg, 1);
- *val = tap_cfg.tap_x_en;
- return ret;
- }
- /**
- * @brief Threshold for tap recognition.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tap_ths in reg TAP_THS_6D
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_threshold_x_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_tap_ths_6d_t tap_ths_6d;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_THS_6D,
- (uint8_t *)&tap_ths_6d, 1);
- if (ret == 0)
- {
- tap_ths_6d.tap_ths = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_TAP_THS_6D,
- (uint8_t *)&tap_ths_6d, 1);
- }
- return ret;
- }
- /**
- * @brief Threshold for tap recognition.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tap_ths in reg TAP_THS_6D
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_threshold_x_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_tap_ths_6d_t tap_ths_6d;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_THS_6D,
- (uint8_t *)&tap_ths_6d, 1);
- *val = tap_ths_6d.tap_ths;
- return ret;
- }
- /**
- * @brief Maximum duration is the maximum time of an overthreshold signal
- * detection to be recognized as a tap event.
- * The default value of these bits is 00b which corresponds to
- * 4*ODR_XL time.
- * If the SHOCK[1:0] bits are set to a different
- * value, 1LSB corresponds to 8*ODR_XL time.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of shock in reg INT_DUR2
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_shock_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_int_dur2_t int_dur2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_INT_DUR2,
- (uint8_t *)&int_dur2, 1);
- if (ret == 0)
- {
- int_dur2.shock = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_INT_DUR2,
- (uint8_t *)&int_dur2, 1);
- }
- return ret;
- }
- /**
- * @brief Maximum duration is the maximum time of an overthreshold signal
- * detection to be recognized as a tap event.
- * The default value of these bits is 00b which corresponds to
- * 4*ODR_XL time.
- * If the SHOCK[1:0] bits are set to a different value, 1LSB
- * corresponds to 8*ODR_XL time.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of shock in reg INT_DUR2
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_shock_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_int_dur2_t int_dur2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_INT_DUR2,
- (uint8_t *)&int_dur2, 1);
- *val = int_dur2.shock;
- return ret;
- }
- /**
- * @brief Quiet time is the time after the first detected tap in which there
- * must not be any overthreshold event.
- * The default value of these bits is 00b which corresponds to
- * 2*ODR_XL time.
- * If the QUIET[1:0] bits are set to a different value, 1LSB
- * corresponds to 4*ODR_XL time.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of quiet in reg INT_DUR2
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_quiet_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_int_dur2_t int_dur2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_INT_DUR2,
- (uint8_t *)&int_dur2, 1);
- if (ret == 0)
- {
- int_dur2.quiet = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_INT_DUR2,
- (uint8_t *)&int_dur2, 1);
- }
- return ret;
- }
- /**
- * @brief Quiet time is the time after the first detected tap in which there
- * must not be any overthreshold event.
- * The default value of these bits is 00b which corresponds to
- * 2*ODR_XL time.
- * If the QUIET[1:0] bits are set to a different value, 1LSB
- * corresponds to 4*ODR_XL time.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of quiet in reg INT_DUR2
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_quiet_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_int_dur2_t int_dur2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_INT_DUR2,
- (uint8_t *)&int_dur2, 1);
- *val = int_dur2.quiet;
- return ret;
- }
- /**
- * @brief When double tap recognition is enabled, this register expresses the
- * maximum time between two consecutive detected taps to determine a
- * double tap event.
- * The default value of these bits is 0000b which corresponds to
- * 16*ODR_XL time.
- * If the DUR[3:0] bits are set to a different value,1LSB corresponds
- * to 32*ODR_XL time.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of dur in reg INT_DUR2
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_dur_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_int_dur2_t int_dur2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_INT_DUR2,
- (uint8_t *)&int_dur2, 1);
- if (ret == 0)
- {
- int_dur2.dur = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_INT_DUR2,
- (uint8_t *)&int_dur2, 1);
- }
- return ret;
- }
- /**
- * @brief When double tap recognition is enabled, this register expresses the
- * maximum time between two consecutive detected taps to determine a
- * double tap event.
- * The default value of these bits is 0000b which corresponds to
- * 16*ODR_XL time.
- * If the DUR[3:0] bits are set to a different value,1LSB corresponds
- * to 32*ODR_XL time.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of dur in reg INT_DUR2
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_dur_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_int_dur2_t int_dur2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_INT_DUR2,
- (uint8_t *)&int_dur2, 1);
- *val = int_dur2.dur;
- return ret;
- }
- /**
- * @brief Single/double-tap event enable/disable.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of
- * single_double_tap in reg WAKE_UP_THS
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_single_double_tap_t val)
- {
- lsm6ds3tr_c_wake_up_ths_t wake_up_ths;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_THS,
- (uint8_t *)&wake_up_ths, 1);
- if (ret == 0)
- {
- wake_up_ths.single_double_tap = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_WAKE_UP_THS,
- (uint8_t *)&wake_up_ths, 1);
- }
- return ret;
- }
- /**
- * @brief Single/double-tap event enable/disable.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of single_double_tap
- * in reg WAKE_UP_THS
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tap_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_single_double_tap_t *val)
- {
- lsm6ds3tr_c_wake_up_ths_t wake_up_ths;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_THS,
- (uint8_t *)&wake_up_ths, 1);
- switch (wake_up_ths.single_double_tap)
- {
- case LSM6DS3TR_C_ONLY_SINGLE:
- *val = LSM6DS3TR_C_ONLY_SINGLE;
- break;
- case LSM6DS3TR_C_BOTH_SINGLE_DOUBLE:
- *val = LSM6DS3TR_C_BOTH_SINGLE_DOUBLE;
- break;
- default:
- *val = LSM6DS3TR_C_TAP_MODE_ND;
- break;
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_ Six_position_detection(6D/4D)
- * @brief This section groups all the functions concerning six
- * position detection (6D).
- * @{
- *
- */
- /**
- * @brief LPF2 feed 6D function selection.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of low_pass_on_6d in
- * reg CTRL8_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_6d_feed_data_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_low_pass_on_6d_t val)
- {
- lsm6ds3tr_c_ctrl8_xl_t ctrl8_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- if (ret == 0)
- {
- ctrl8_xl.low_pass_on_6d = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- }
- return ret;
- }
- /**
- * @brief LPF2 feed 6D function selection.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of low_pass_on_6d in reg CTRL8_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_6d_feed_data_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_low_pass_on_6d_t *val)
- {
- lsm6ds3tr_c_ctrl8_xl_t ctrl8_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL8_XL,
- (uint8_t *)&ctrl8_xl, 1);
- switch (ctrl8_xl.low_pass_on_6d)
- {
- case LSM6DS3TR_C_ODR_DIV_2_FEED:
- *val = LSM6DS3TR_C_ODR_DIV_2_FEED;
- break;
- case LSM6DS3TR_C_LPF2_FEED:
- *val = LSM6DS3TR_C_LPF2_FEED;
- break;
- default:
- *val = LSM6DS3TR_C_6D_FEED_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Threshold for 4D/6D function.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of sixd_ths in reg TAP_THS_6D
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_6d_threshold_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_sixd_ths_t val)
- {
- lsm6ds3tr_c_tap_ths_6d_t tap_ths_6d;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_THS_6D,
- (uint8_t *)&tap_ths_6d, 1);
- if (ret == 0)
- {
- tap_ths_6d.sixd_ths = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_TAP_THS_6D,
- (uint8_t *)&tap_ths_6d, 1);
- }
- return ret;
- }
- /**
- * @brief Threshold for 4D/6D function.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of sixd_ths in reg TAP_THS_6D
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_6d_threshold_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_sixd_ths_t *val)
- {
- lsm6ds3tr_c_tap_ths_6d_t tap_ths_6d;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_THS_6D,
- (uint8_t *)&tap_ths_6d, 1);
- switch (tap_ths_6d.sixd_ths)
- {
- case LSM6DS3TR_C_DEG_80:
- *val = LSM6DS3TR_C_DEG_80;
- break;
- case LSM6DS3TR_C_DEG_70:
- *val = LSM6DS3TR_C_DEG_70;
- break;
- case LSM6DS3TR_C_DEG_60:
- *val = LSM6DS3TR_C_DEG_60;
- break;
- case LSM6DS3TR_C_DEG_50:
- *val = LSM6DS3TR_C_DEG_50;
- break;
- default:
- *val = LSM6DS3TR_C_6D_TH_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief 4D orientation detection enable.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of d4d_en in reg TAP_THS_6D
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_4d_mode_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_tap_ths_6d_t tap_ths_6d;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_THS_6D,
- (uint8_t *)&tap_ths_6d, 1);
- if (ret == 0)
- {
- tap_ths_6d.d4d_en = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_TAP_THS_6D,
- (uint8_t *)&tap_ths_6d, 1);
- }
- return ret;
- }
- /**
- * @brief 4D orientation detection enable.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of d4d_en in reg TAP_THS_6D
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_4d_mode_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_tap_ths_6d_t tap_ths_6d;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_TAP_THS_6D,
- (uint8_t *)&tap_ths_6d, 1);
- *val = tap_ths_6d.d4d_en;
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_free_fall
- * @brief This section group all the functions concerning the free
- * fall detection.
- * @{
- *
- */
- /**
- * @brief Free-fall duration event. 1LSb = 1 / ODR[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of ff_dur in reg WAKE_UP_DUR
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_ff_dur_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_wake_up_dur_t wake_up_dur;
- lsm6ds3tr_c_free_fall_t free_fall;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FREE_FALL,
- (uint8_t *)&free_fall, 1);
- if (ret == 0)
- {
- free_fall.ff_dur = (val & 0x1FU);
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FREE_FALL,
- (uint8_t *)&free_fall, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_DUR,
- (uint8_t *)&wake_up_dur, 1);
- if (ret == 0)
- {
- wake_up_dur.ff_dur = (val & 0x20U) >> 5;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_WAKE_UP_DUR,
- (uint8_t *)&wake_up_dur, 1);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Free-fall duration event. 1LSb = 1 / ODR[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of ff_dur in reg WAKE_UP_DUR
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_ff_dur_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_wake_up_dur_t wake_up_dur;
- lsm6ds3tr_c_free_fall_t free_fall;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_WAKE_UP_DUR,
- (uint8_t *)&wake_up_dur, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FREE_FALL,
- (uint8_t *)&free_fall, 1);
- }
- *val = (wake_up_dur.ff_dur << 5) + free_fall.ff_dur;
- return ret;
- }
- /**
- * @brief Free fall threshold setting.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of ff_ths in reg FREE_FALL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_ff_threshold_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_ff_ths_t val)
- {
- lsm6ds3tr_c_free_fall_t free_fall;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FREE_FALL,
- (uint8_t *)&free_fall, 1);
- if (ret == 0)
- {
- free_fall.ff_ths = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FREE_FALL,
- (uint8_t *)&free_fall, 1);
- }
- return ret;
- }
- /**
- * @brief Free fall threshold setting.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of ff_ths in reg FREE_FALL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_ff_threshold_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_ff_ths_t *val)
- {
- lsm6ds3tr_c_free_fall_t free_fall;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FREE_FALL,
- (uint8_t *)&free_fall, 1);
- switch (free_fall.ff_ths)
- {
- case LSM6DS3TR_C_FF_TSH_156mg:
- *val = LSM6DS3TR_C_FF_TSH_156mg;
- break;
- case LSM6DS3TR_C_FF_TSH_219mg:
- *val = LSM6DS3TR_C_FF_TSH_219mg;
- break;
- case LSM6DS3TR_C_FF_TSH_250mg:
- *val = LSM6DS3TR_C_FF_TSH_250mg;
- break;
- case LSM6DS3TR_C_FF_TSH_312mg:
- *val = LSM6DS3TR_C_FF_TSH_312mg;
- break;
- case LSM6DS3TR_C_FF_TSH_344mg:
- *val = LSM6DS3TR_C_FF_TSH_344mg;
- break;
- case LSM6DS3TR_C_FF_TSH_406mg:
- *val = LSM6DS3TR_C_FF_TSH_406mg;
- break;
- case LSM6DS3TR_C_FF_TSH_469mg:
- *val = LSM6DS3TR_C_FF_TSH_469mg;
- break;
- case LSM6DS3TR_C_FF_TSH_500mg:
- *val = LSM6DS3TR_C_FF_TSH_500mg;
- break;
- default:
- *val = LSM6DS3TR_C_FF_TSH_ND;
- break;
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_fifo
- * @brief This section group all the functions concerning the
- * fifo usage
- * @{
- *
- */
- /**
- * @brief FIFO watermark level selection.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of fth in reg FIFO_CTRL1
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_watermark_set(stmdev_ctx_t *ctx,
- uint16_t val)
- {
- lsm6ds3tr_c_fifo_ctrl1_t fifo_ctrl1;
- lsm6ds3tr_c_fifo_ctrl2_t fifo_ctrl2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL2,
- (uint8_t *)&fifo_ctrl2, 1);
- if (ret == 0)
- {
- fifo_ctrl1.fth = (uint8_t)(0x00FFU & val);
- fifo_ctrl2.fth = (uint8_t)((0x0700U & val) >> 8);
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL1,
- (uint8_t *)&fifo_ctrl1, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL2,
- (uint8_t *)&fifo_ctrl2, 1);
- }
- }
- return ret;
- }
- /**
- * @brief FIFO watermark level selection.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of fth in reg FIFO_CTRL1
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_watermark_get(stmdev_ctx_t *ctx,
- uint16_t *val)
- {
- lsm6ds3tr_c_fifo_ctrl1_t fifo_ctrl1;
- lsm6ds3tr_c_fifo_ctrl2_t fifo_ctrl2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL1,
- (uint8_t *)&fifo_ctrl1, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL2,
- (uint8_t *)&fifo_ctrl2, 1);
- }
- *val = ((uint16_t)fifo_ctrl2.fth << 8) + (uint16_t)fifo_ctrl1.fth;
- return ret;
- }
- /**
- * @brief FIFO data level.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val get the values of diff_fifo in reg FIFO_STATUS1 and
- * FIFO_STATUS2(diff_fifo), it is recommended to set the
- * BDU bit.
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_data_level_get(stmdev_ctx_t *ctx,
- uint16_t *val)
- {
- lsm6ds3tr_c_fifo_status1_t fifo_status1;
- lsm6ds3tr_c_fifo_status2_t fifo_status2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_STATUS1,
- (uint8_t *)&fifo_status1, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_STATUS2,
- (uint8_t *)&fifo_status2, 1);
- *val = ((uint16_t) fifo_status2.diff_fifo << 8) +
- (uint16_t) fifo_status1.diff_fifo;
- }
- return ret;
- }
- /**
- * @brief FIFO watermark.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val get the values of watermark in reg FIFO_STATUS2 and
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_wtm_flag_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_fifo_status2_t fifo_status2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_STATUS2,
- (uint8_t *)&fifo_status2, 1);
- *val = fifo_status2.waterm;
- return ret;
- }
- /**
- * @brief FIFO pattern.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val get the values of fifo_pattern in reg FIFO_STATUS3 and
- * FIFO_STATUS4, it is recommended to set the BDU bit
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_pattern_get(stmdev_ctx_t *ctx, uint16_t *val)
- {
- lsm6ds3tr_c_fifo_status3_t fifo_status3;
- lsm6ds3tr_c_fifo_status4_t fifo_status4;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_STATUS3,
- (uint8_t *)&fifo_status3, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_STATUS4,
- (uint8_t *)&fifo_status4, 1);
- *val = ((uint16_t)fifo_status4.fifo_pattern << 8) +
- fifo_status3.fifo_pattern;
- }
- return ret;
- }
- /**
- * @brief Batching of temperature data[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of fifo_temp_en in reg FIFO_CTRL2
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_temp_batch_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_fifo_ctrl2_t fifo_ctrl2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL2,
- (uint8_t *)&fifo_ctrl2, 1);
- if (ret == 0)
- {
- fifo_ctrl2.fifo_temp_en = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL2,
- (uint8_t *)&fifo_ctrl2, 1);
- }
- return ret;
- }
- /**
- * @brief Batching of temperature data[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of fifo_temp_en in reg FIFO_CTRL2
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_temp_batch_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_fifo_ctrl2_t fifo_ctrl2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL2,
- (uint8_t *)&fifo_ctrl2, 1);
- *val = fifo_ctrl2.fifo_temp_en;
- return ret;
- }
- /**
- * @brief Trigger signal for FIFO write operation.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val act on FIFO_CTRL2(timer_pedo_fifo_drdy)
- * and MASTER_CONFIG(data_valid_sel_fifo)
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_write_trigger_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_trigger_fifo_t val)
- {
- lsm6ds3tr_c_fifo_ctrl2_t fifo_ctrl2;
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL2,
- (uint8_t *)&fifo_ctrl2, 1);
- if (ret == 0)
- {
- fifo_ctrl2.timer_pedo_fifo_drdy = (uint8_t)val & 0x01U;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL2,
- (uint8_t *)&fifo_ctrl2, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- if (ret == 0)
- {
- master_config.data_valid_sel_fifo = (((uint8_t)val & 0x02U) >> 1);
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Trigger signal for FIFO write operation.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val act on FIFO_CTRL2(timer_pedo_fifo_drdy)
- * and MASTER_CONFIG(data_valid_sel_fifo)
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_write_trigger_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_trigger_fifo_t *val)
- {
- lsm6ds3tr_c_fifo_ctrl2_t fifo_ctrl2;
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL2,
- (uint8_t *)&fifo_ctrl2, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- switch ((fifo_ctrl2.timer_pedo_fifo_drdy << 1) +
- fifo_ctrl2. timer_pedo_fifo_drdy)
- {
- case LSM6DS3TR_C_TRG_XL_GY_DRDY:
- *val = LSM6DS3TR_C_TRG_XL_GY_DRDY;
- break;
- case LSM6DS3TR_C_TRG_STEP_DETECT:
- *val = LSM6DS3TR_C_TRG_STEP_DETECT;
- break;
- case LSM6DS3TR_C_TRG_SH_DRDY:
- *val = LSM6DS3TR_C_TRG_SH_DRDY;
- break;
- default:
- *val = LSM6DS3TR_C_TRG_SH_ND;
- break;
- }
- }
- return ret;
- }
- /**
- * @brief Enable pedometer step counter and timestamp as 4th
- * FIFO data set.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of timer_pedo_fifo_en in reg FIFO_CTRL2
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_pedo_and_timestamp_batch_set(
- stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_fifo_ctrl2_t fifo_ctrl2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL2,
- (uint8_t *)&fifo_ctrl2, 1);
- if (ret == 0)
- {
- fifo_ctrl2.timer_pedo_fifo_en = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL2,
- (uint8_t *)&fifo_ctrl2, 1);
- }
- return ret;
- }
- /**
- * @brief Enable pedometer step counter and timestamp as 4th
- * FIFO data set.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of timer_pedo_fifo_en in reg FIFO_CTRL2
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_pedo_and_timestamp_batch_get(
- stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_fifo_ctrl2_t fifo_ctrl2;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL2,
- (uint8_t *)&fifo_ctrl2, 1);
- *val = fifo_ctrl2.timer_pedo_fifo_en;
- return ret;
- }
- /**
- * @brief Selects Batching Data Rate (writing frequency in FIFO) for
- * accelerometer data.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of dec_fifo_xl in reg FIFO_CTRL3
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_xl_batch_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_dec_fifo_xl_t val)
- {
- lsm6ds3tr_c_fifo_ctrl3_t fifo_ctrl3;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL3,
- (uint8_t *)&fifo_ctrl3, 1);
- if (ret == 0)
- {
- fifo_ctrl3.dec_fifo_xl = (uint8_t)val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL3,
- (uint8_t *)&fifo_ctrl3, 1);
- }
- return ret;
- }
- /**
- * @brief Selects Batching Data Rate (writing frequency in FIFO) for
- * accelerometer data.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of dec_fifo_xl in reg FIFO_CTRL3
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_xl_batch_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_dec_fifo_xl_t *val)
- {
- lsm6ds3tr_c_fifo_ctrl3_t fifo_ctrl3;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL3,
- (uint8_t *)&fifo_ctrl3, 1);
- switch (fifo_ctrl3.dec_fifo_xl)
- {
- case LSM6DS3TR_C_FIFO_XL_DISABLE:
- *val = LSM6DS3TR_C_FIFO_XL_DISABLE;
- break;
- case LSM6DS3TR_C_FIFO_XL_NO_DEC:
- *val = LSM6DS3TR_C_FIFO_XL_NO_DEC;
- break;
- case LSM6DS3TR_C_FIFO_XL_DEC_2:
- *val = LSM6DS3TR_C_FIFO_XL_DEC_2;
- break;
- case LSM6DS3TR_C_FIFO_XL_DEC_3:
- *val = LSM6DS3TR_C_FIFO_XL_DEC_3;
- break;
- case LSM6DS3TR_C_FIFO_XL_DEC_4:
- *val = LSM6DS3TR_C_FIFO_XL_DEC_4;
- break;
- case LSM6DS3TR_C_FIFO_XL_DEC_8:
- *val = LSM6DS3TR_C_FIFO_XL_DEC_8;
- break;
- case LSM6DS3TR_C_FIFO_XL_DEC_16:
- *val = LSM6DS3TR_C_FIFO_XL_DEC_16;
- break;
- case LSM6DS3TR_C_FIFO_XL_DEC_32:
- *val = LSM6DS3TR_C_FIFO_XL_DEC_32;
- break;
- default:
- *val = LSM6DS3TR_C_FIFO_XL_DEC_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Selects Batching Data Rate (writing frequency in FIFO)
- * for gyroscope data.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of dec_fifo_gyro in reg FIFO_CTRL3
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_gy_batch_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_dec_fifo_gyro_t val)
- {
- lsm6ds3tr_c_fifo_ctrl3_t fifo_ctrl3;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL3,
- (uint8_t *)&fifo_ctrl3, 1);
- if (ret == 0)
- {
- fifo_ctrl3.dec_fifo_gyro = (uint8_t)val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL3,
- (uint8_t *)&fifo_ctrl3, 1);
- }
- return ret;
- }
- /**
- * @brief Selects Batching Data Rate (writing frequency in FIFO)
- * for gyroscope data.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of dec_fifo_gyro in reg FIFO_CTRL3
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_gy_batch_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_dec_fifo_gyro_t *val)
- {
- lsm6ds3tr_c_fifo_ctrl3_t fifo_ctrl3;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL3,
- (uint8_t *)&fifo_ctrl3, 1);
- switch (fifo_ctrl3.dec_fifo_gyro)
- {
- case LSM6DS3TR_C_FIFO_GY_DISABLE:
- *val = LSM6DS3TR_C_FIFO_GY_DISABLE;
- break;
- case LSM6DS3TR_C_FIFO_GY_NO_DEC:
- *val = LSM6DS3TR_C_FIFO_GY_NO_DEC;
- break;
- case LSM6DS3TR_C_FIFO_GY_DEC_2:
- *val = LSM6DS3TR_C_FIFO_GY_DEC_2;
- break;
- case LSM6DS3TR_C_FIFO_GY_DEC_3:
- *val = LSM6DS3TR_C_FIFO_GY_DEC_3;
- break;
- case LSM6DS3TR_C_FIFO_GY_DEC_4:
- *val = LSM6DS3TR_C_FIFO_GY_DEC_4;
- break;
- case LSM6DS3TR_C_FIFO_GY_DEC_8:
- *val = LSM6DS3TR_C_FIFO_GY_DEC_8;
- break;
- case LSM6DS3TR_C_FIFO_GY_DEC_16:
- *val = LSM6DS3TR_C_FIFO_GY_DEC_16;
- break;
- case LSM6DS3TR_C_FIFO_GY_DEC_32:
- *val = LSM6DS3TR_C_FIFO_GY_DEC_32;
- break;
- default:
- *val = LSM6DS3TR_C_FIFO_GY_DEC_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Selects Batching Data Rate (writing frequency in FIFO)
- * for third data set.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of dec_ds3_fifo in reg FIFO_CTRL4
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_dataset_3_batch_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_dec_ds3_fifo_t val)
- {
- lsm6ds3tr_c_fifo_ctrl4_t fifo_ctrl4;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL4,
- (uint8_t *)&fifo_ctrl4, 1);
- if (ret == 0)
- {
- fifo_ctrl4.dec_ds3_fifo = (uint8_t)val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL4,
- (uint8_t *)&fifo_ctrl4, 1);
- }
- return ret;
- }
- /**
- * @brief Selects Batching Data Rate (writing frequency in FIFO)
- * for third data set.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of dec_ds3_fifo in reg FIFO_CTRL4
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_dataset_3_batch_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_dec_ds3_fifo_t *val)
- {
- lsm6ds3tr_c_fifo_ctrl4_t fifo_ctrl4;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL4,
- (uint8_t *)&fifo_ctrl4, 1);
- switch (fifo_ctrl4.dec_ds3_fifo)
- {
- case LSM6DS3TR_C_FIFO_DS3_DISABLE:
- *val = LSM6DS3TR_C_FIFO_DS3_DISABLE;
- break;
- case LSM6DS3TR_C_FIFO_DS3_NO_DEC:
- *val = LSM6DS3TR_C_FIFO_DS3_NO_DEC;
- break;
- case LSM6DS3TR_C_FIFO_DS3_DEC_2:
- *val = LSM6DS3TR_C_FIFO_DS3_DEC_2;
- break;
- case LSM6DS3TR_C_FIFO_DS3_DEC_3:
- *val = LSM6DS3TR_C_FIFO_DS3_DEC_3;
- break;
- case LSM6DS3TR_C_FIFO_DS3_DEC_4:
- *val = LSM6DS3TR_C_FIFO_DS3_DEC_4;
- break;
- case LSM6DS3TR_C_FIFO_DS3_DEC_8:
- *val = LSM6DS3TR_C_FIFO_DS3_DEC_8;
- break;
- case LSM6DS3TR_C_FIFO_DS3_DEC_16:
- *val = LSM6DS3TR_C_FIFO_DS3_DEC_16;
- break;
- case LSM6DS3TR_C_FIFO_DS3_DEC_32:
- *val = LSM6DS3TR_C_FIFO_DS3_DEC_32;
- break;
- default:
- *val = LSM6DS3TR_C_FIFO_DS3_DEC_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Selects Batching Data Rate (writing frequency in FIFO)
- * for fourth data set.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of dec_ds4_fifo in reg FIFO_CTRL4
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_dataset_4_batch_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_dec_ds4_fifo_t val)
- {
- lsm6ds3tr_c_fifo_ctrl4_t fifo_ctrl4;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL4,
- (uint8_t *)&fifo_ctrl4, 1);
- if (ret == 0)
- {
- fifo_ctrl4.dec_ds4_fifo = (uint8_t)val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL4,
- (uint8_t *)&fifo_ctrl4, 1);
- }
- return ret;
- }
- /**
- * @brief Selects Batching Data Rate (writing frequency in FIFO) for
- * fourth data set.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of dec_ds4_fifo in reg FIFO_CTRL4
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_dataset_4_batch_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_dec_ds4_fifo_t *val)
- {
- lsm6ds3tr_c_fifo_ctrl4_t fifo_ctrl4;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL4,
- (uint8_t *)&fifo_ctrl4, 1);
- switch (fifo_ctrl4.dec_ds4_fifo)
- {
- case LSM6DS3TR_C_FIFO_DS4_DISABLE:
- *val = LSM6DS3TR_C_FIFO_DS4_DISABLE;
- break;
- case LSM6DS3TR_C_FIFO_DS4_NO_DEC:
- *val = LSM6DS3TR_C_FIFO_DS4_NO_DEC;
- break;
- case LSM6DS3TR_C_FIFO_DS4_DEC_2:
- *val = LSM6DS3TR_C_FIFO_DS4_DEC_2;
- break;
- case LSM6DS3TR_C_FIFO_DS4_DEC_3:
- *val = LSM6DS3TR_C_FIFO_DS4_DEC_3;
- break;
- case LSM6DS3TR_C_FIFO_DS4_DEC_4:
- *val = LSM6DS3TR_C_FIFO_DS4_DEC_4;
- break;
- case LSM6DS3TR_C_FIFO_DS4_DEC_8:
- *val = LSM6DS3TR_C_FIFO_DS4_DEC_8;
- break;
- case LSM6DS3TR_C_FIFO_DS4_DEC_16:
- *val = LSM6DS3TR_C_FIFO_DS4_DEC_16;
- break;
- case LSM6DS3TR_C_FIFO_DS4_DEC_32:
- *val = LSM6DS3TR_C_FIFO_DS4_DEC_32;
- break;
- default:
- *val = LSM6DS3TR_C_FIFO_DS4_DEC_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief 8-bit data storage in FIFO.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of only_high_data in reg FIFO_CTRL4
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_xl_gy_8bit_format_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_fifo_ctrl4_t fifo_ctrl4;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL4,
- (uint8_t *)&fifo_ctrl4, 1);
- if (ret == 0)
- {
- fifo_ctrl4.only_high_data = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL4,
- (uint8_t *)&fifo_ctrl4, 1);
- }
- return ret;
- }
- /**
- * @brief 8-bit data storage in FIFO.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of only_high_data in reg FIFO_CTRL4
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_xl_gy_8bit_format_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_fifo_ctrl4_t fifo_ctrl4;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL4,
- (uint8_t *)&fifo_ctrl4, 1);
- *val = fifo_ctrl4.only_high_data;
- return ret;
- }
- /**
- * @brief Sensing chain FIFO stop values memorization at threshold
- * level.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of stop_on_fth in reg FIFO_CTRL4
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_stop_on_wtm_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_fifo_ctrl4_t fifo_ctrl4;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL4,
- (uint8_t *)&fifo_ctrl4, 1);
- if (ret == 0)
- {
- fifo_ctrl4.stop_on_fth = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL4,
- (uint8_t *)&fifo_ctrl4, 1);
- }
- return ret;
- }
- /**
- * @brief Sensing chain FIFO stop values memorization at threshold
- * level.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of stop_on_fth in reg FIFO_CTRL4
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_stop_on_wtm_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_fifo_ctrl4_t fifo_ctrl4;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL4,
- (uint8_t *)&fifo_ctrl4, 1);
- *val = fifo_ctrl4.stop_on_fth;
- return ret;
- }
- /**
- * @brief FIFO mode selection.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of fifo_mode in reg FIFO_CTRL5
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_fifo_mode_t val)
- {
- lsm6ds3tr_c_fifo_ctrl5_t fifo_ctrl5;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL5,
- (uint8_t *)&fifo_ctrl5, 1);
- if (ret == 0)
- {
- fifo_ctrl5.fifo_mode = (uint8_t)val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL5,
- (uint8_t *)&fifo_ctrl5, 1);
- }
- return ret;
- }
- /**
- * @brief FIFO mode selection.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of fifo_mode in reg FIFO_CTRL5
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_fifo_mode_t *val)
- {
- lsm6ds3tr_c_fifo_ctrl5_t fifo_ctrl5;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL5,
- (uint8_t *)&fifo_ctrl5, 1);
- switch (fifo_ctrl5.fifo_mode)
- {
- case LSM6DS3TR_C_BYPASS_MODE:
- *val = LSM6DS3TR_C_BYPASS_MODE;
- break;
- case LSM6DS3TR_C_FIFO_MODE:
- *val = LSM6DS3TR_C_FIFO_MODE;
- break;
- case LSM6DS3TR_C_STREAM_TO_FIFO_MODE:
- *val = LSM6DS3TR_C_STREAM_TO_FIFO_MODE;
- break;
- case LSM6DS3TR_C_BYPASS_TO_STREAM_MODE:
- *val = LSM6DS3TR_C_BYPASS_TO_STREAM_MODE;
- break;
- case LSM6DS3TR_C_STREAM_MODE:
- *val = LSM6DS3TR_C_STREAM_MODE;
- break;
- default:
- *val = LSM6DS3TR_C_FIFO_MODE_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief FIFO ODR selection, setting FIFO_MODE also.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of odr_fifo in reg FIFO_CTRL5
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_data_rate_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_odr_fifo_t val)
- {
- lsm6ds3tr_c_fifo_ctrl5_t fifo_ctrl5;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL5,
- (uint8_t *)&fifo_ctrl5, 1);
- if (ret == 0)
- {
- fifo_ctrl5.odr_fifo = (uint8_t)val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_FIFO_CTRL5,
- (uint8_t *)&fifo_ctrl5, 1);
- }
- return ret;
- }
- /**
- * @brief FIFO ODR selection, setting FIFO_MODE also.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of odr_fifo in reg FIFO_CTRL5
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_fifo_data_rate_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_odr_fifo_t *val)
- {
- lsm6ds3tr_c_fifo_ctrl5_t fifo_ctrl5;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_FIFO_CTRL5,
- (uint8_t *)&fifo_ctrl5, 1);
- switch (fifo_ctrl5.odr_fifo)
- {
- case LSM6DS3TR_C_FIFO_DISABLE:
- *val = LSM6DS3TR_C_FIFO_DISABLE;
- break;
- case LSM6DS3TR_C_FIFO_12Hz5:
- *val = LSM6DS3TR_C_FIFO_12Hz5;
- break;
- case LSM6DS3TR_C_FIFO_26Hz:
- *val = LSM6DS3TR_C_FIFO_26Hz;
- break;
- case LSM6DS3TR_C_FIFO_52Hz:
- *val = LSM6DS3TR_C_FIFO_52Hz;
- break;
- case LSM6DS3TR_C_FIFO_104Hz:
- *val = LSM6DS3TR_C_FIFO_104Hz;
- break;
- case LSM6DS3TR_C_FIFO_208Hz:
- *val = LSM6DS3TR_C_FIFO_208Hz;
- break;
- case LSM6DS3TR_C_FIFO_416Hz:
- *val = LSM6DS3TR_C_FIFO_416Hz;
- break;
- case LSM6DS3TR_C_FIFO_833Hz:
- *val = LSM6DS3TR_C_FIFO_833Hz;
- break;
- case LSM6DS3TR_C_FIFO_1k66Hz:
- *val = LSM6DS3TR_C_FIFO_1k66Hz;
- break;
- case LSM6DS3TR_C_FIFO_3k33Hz:
- *val = LSM6DS3TR_C_FIFO_3k33Hz;
- break;
- case LSM6DS3TR_C_FIFO_6k66Hz:
- *val = LSM6DS3TR_C_FIFO_6k66Hz;
- break;
- default:
- *val = LSM6DS3TR_C_FIFO_RATE_ND;
- break;
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_DEN_functionality
- * @brief This section groups all the functions concerning DEN
- * functionality.
- * @{
- *
- */
- /**
- * @brief DEN active level configuration.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of den_lh in reg CTRL5_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_den_polarity_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_den_lh_t val)
- {
- lsm6ds3tr_c_ctrl5_c_t ctrl5_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL5_C,
- (uint8_t *)&ctrl5_c, 1);
- if (ret == 0)
- {
- ctrl5_c.den_lh = (uint8_t)val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL5_C,
- (uint8_t *)&ctrl5_c, 1);
- }
- return ret;
- }
- /**
- * @brief DEN active level configuration.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of den_lh in reg CTRL5_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_den_polarity_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_den_lh_t *val)
- {
- lsm6ds3tr_c_ctrl5_c_t ctrl5_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL5_C,
- (uint8_t *)&ctrl5_c, 1);
- switch (ctrl5_c.den_lh)
- {
- case LSM6DS3TR_C_DEN_ACT_LOW:
- *val = LSM6DS3TR_C_DEN_ACT_LOW;
- break;
- case LSM6DS3TR_C_DEN_ACT_HIGH:
- *val = LSM6DS3TR_C_DEN_ACT_HIGH;
- break;
- default:
- *val = LSM6DS3TR_C_DEN_POL_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief DEN functionality marking mode[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of den_mode in reg CTRL6_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_den_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_den_mode_t val)
- {
- lsm6ds3tr_c_ctrl6_c_t ctrl6_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL6_C,
- (uint8_t *)&ctrl6_c, 1);
- if (ret == 0)
- {
- ctrl6_c.den_mode = (uint8_t)val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL6_C,
- (uint8_t *)&ctrl6_c, 1);
- }
- return ret;
- }
- /**
- * @brief DEN functionality marking mode[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of den_mode in reg CTRL6_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_den_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_den_mode_t *val)
- {
- lsm6ds3tr_c_ctrl6_c_t ctrl6_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL6_C,
- (uint8_t *)&ctrl6_c, 1);
- switch (ctrl6_c.den_mode)
- {
- case LSM6DS3TR_C_DEN_DISABLE:
- *val = LSM6DS3TR_C_DEN_DISABLE;
- break;
- case LSM6DS3TR_C_LEVEL_LETCHED:
- *val = LSM6DS3TR_C_LEVEL_LETCHED;
- break;
- case LSM6DS3TR_C_LEVEL_TRIGGER:
- *val = LSM6DS3TR_C_LEVEL_TRIGGER;
- break;
- case LSM6DS3TR_C_EDGE_TRIGGER:
- *val = LSM6DS3TR_C_EDGE_TRIGGER;
- break;
- default:
- *val = LSM6DS3TR_C_DEN_MODE_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Extend DEN functionality to accelerometer sensor.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of den_xl_g in reg CTRL9_XL
- * and den_xl_en in CTRL4_C.
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_den_enable_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_den_xl_en_t val)
- {
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- lsm6ds3tr_c_ctrl9_xl_t ctrl9_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- if (ret == 0)
- {
- ctrl9_xl.den_xl_g = (uint8_t)val & 0x01U;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- if (ret == 0)
- {
- ctrl4_c.den_xl_en = (uint8_t)val & 0x02U;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Extend DEN functionality to accelerometer sensor. [get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of den_xl_g in reg CTRL9_XL
- * and den_xl_en in CTRL4_C.
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_den_enable_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_den_xl_en_t *val)
- {
- lsm6ds3tr_c_ctrl4_c_t ctrl4_c;
- lsm6ds3tr_c_ctrl9_xl_t ctrl9_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL4_C,
- (uint8_t *)&ctrl4_c, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- switch ((ctrl4_c.den_xl_en << 1) + ctrl9_xl.den_xl_g)
- {
- case LSM6DS3TR_C_STAMP_IN_GY_DATA:
- *val = LSM6DS3TR_C_STAMP_IN_GY_DATA;
- break;
- case LSM6DS3TR_C_STAMP_IN_XL_DATA:
- *val = LSM6DS3TR_C_STAMP_IN_XL_DATA;
- break;
- case LSM6DS3TR_C_STAMP_IN_GY_XL_DATA:
- *val = LSM6DS3TR_C_STAMP_IN_GY_XL_DATA;
- break;
- default:
- *val = LSM6DS3TR_C_DEN_STAMP_ND;
- break;
- }
- }
- return ret;
- }
- /**
- * @brief DEN value stored in LSB of Z-axis.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of den_z in reg CTRL9_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_den_mark_axis_z_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_ctrl9_xl_t ctrl9_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- if (ret == 0)
- {
- ctrl9_xl.den_z = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- }
- return ret;
- }
- /**
- * @brief DEN value stored in LSB of Z-axis.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of den_z in reg CTRL9_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_den_mark_axis_z_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_ctrl9_xl_t ctrl9_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- *val = ctrl9_xl.den_z;
- return ret;
- }
- /**
- * @brief DEN value stored in LSB of Y-axis.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of den_y in reg CTRL9_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_den_mark_axis_y_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_ctrl9_xl_t ctrl9_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- if (ret == 0)
- {
- ctrl9_xl.den_y = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- }
- return ret;
- }
- /**
- * @brief DEN value stored in LSB of Y-axis.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of den_y in reg CTRL9_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_den_mark_axis_y_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_ctrl9_xl_t ctrl9_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- *val = ctrl9_xl.den_y;
- return ret;
- }
- /**
- * @brief DEN value stored in LSB of X-axis.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of den_x in reg CTRL9_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_den_mark_axis_x_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_ctrl9_xl_t ctrl9_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- if (ret == 0)
- {
- ctrl9_xl.den_x = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- }
- return ret;
- }
- /**
- * @brief DEN value stored in LSB of X-axis.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of den_x in reg CTRL9_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_den_mark_axis_x_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_ctrl9_xl_t ctrl9_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- *val = ctrl9_xl.den_x;
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_Pedometer
- * @brief This section groups all the functions that manage pedometer.
- * @{
- *
- */
- /**
- * @brief Reset pedometer step counter.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of pedo_rst_step in reg CTRL10_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_step_reset_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- if (ret == 0)
- {
- ctrl10_c.pedo_rst_step = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- }
- return ret;
- }
- /**
- * @brief Reset pedometer step counter.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of pedo_rst_step in reg CTRL10_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_step_reset_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- *val = ctrl10_c.pedo_rst_step;
- return ret;
- }
- /**
- * @brief Enable pedometer algorithm.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of pedo_en in reg CTRL10_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_sens_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- if (ret == 0)
- {
- ctrl10_c.pedo_en = val;
- if (val != 0x00U)
- {
- ctrl10_c.func_en = val;
- }
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- }
- return ret;
- }
- /**
- * @brief pedo_sens: Enable pedometer algorithm.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of pedo_en in reg CTRL10_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_sens_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- *val = ctrl10_c.pedo_en;
- return ret;
- }
- /**
- * @brief Minimum threshold to detect a peak. Default is 10h.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of ths_min in reg
- * CONFIG_PEDO_THS_MIN
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_threshold_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_config_pedo_ths_min_t config_pedo_ths_min;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CONFIG_PEDO_THS_MIN,
- (uint8_t *)&config_pedo_ths_min, 1);
- if (ret == 0)
- {
- config_pedo_ths_min.ths_min = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CONFIG_PEDO_THS_MIN,
- (uint8_t *)&config_pedo_ths_min, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Minimum threshold to detect a peak. Default is 10h.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of ths_min in reg CONFIG_PEDO_THS_MIN
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_threshold_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_config_pedo_ths_min_t config_pedo_ths_min;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CONFIG_PEDO_THS_MIN,
- (uint8_t *)&config_pedo_ths_min, 1);
- if (ret == 0)
- {
- *val = config_pedo_ths_min.ths_min;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief pedo_full_scale: Pedometer data range.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of pedo_fs in
- * reg CONFIG_PEDO_THS_MIN
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_full_scale_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_pedo_fs_t val)
- {
- lsm6ds3tr_c_config_pedo_ths_min_t config_pedo_ths_min;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CONFIG_PEDO_THS_MIN,
- (uint8_t *)&config_pedo_ths_min, 1);
- if (ret == 0)
- {
- config_pedo_ths_min.pedo_fs = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CONFIG_PEDO_THS_MIN,
- (uint8_t *)&config_pedo_ths_min, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Pedometer data range.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of pedo_fs in
- * reg CONFIG_PEDO_THS_MIN
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_full_scale_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_pedo_fs_t *val)
- {
- lsm6ds3tr_c_config_pedo_ths_min_t config_pedo_ths_min;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CONFIG_PEDO_THS_MIN,
- (uint8_t *)&config_pedo_ths_min, 1);
- if (ret == 0)
- {
- switch (config_pedo_ths_min.pedo_fs)
- {
- case LSM6DS3TR_C_PEDO_AT_2g:
- *val = LSM6DS3TR_C_PEDO_AT_2g;
- break;
- case LSM6DS3TR_C_PEDO_AT_4g:
- *val = LSM6DS3TR_C_PEDO_AT_4g;
- break;
- default:
- *val = LSM6DS3TR_C_PEDO_FS_ND;
- break;
- }
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Pedometer debounce configuration register (r/w).[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of deb_step in reg PEDO_DEB_REG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_debounce_steps_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_pedo_deb_reg_t pedo_deb_reg;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_PEDO_DEB_REG,
- (uint8_t *)&pedo_deb_reg, 1);
- if (ret == 0)
- {
- pedo_deb_reg.deb_step = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_PEDO_DEB_REG,
- (uint8_t *)&pedo_deb_reg, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Pedometer debounce configuration register (r/w).[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of deb_step in reg PEDO_DEB_REG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_debounce_steps_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_pedo_deb_reg_t pedo_deb_reg;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_PEDO_DEB_REG,
- (uint8_t *)&pedo_deb_reg, 1);
- if (ret == 0)
- {
- *val = pedo_deb_reg.deb_step;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Debounce time. If the time between two consecutive steps is
- * greater than DEB_TIME*80ms, the debouncer is reactivated.
- * Default value: 01101[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of deb_time in reg PEDO_DEB_REG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_timeout_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_pedo_deb_reg_t pedo_deb_reg;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_PEDO_DEB_REG,
- (uint8_t *)&pedo_deb_reg, 1);
- if (ret == 0)
- {
- pedo_deb_reg.deb_time = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_PEDO_DEB_REG,
- (uint8_t *)&pedo_deb_reg, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Debounce time. If the time between two consecutive steps is
- * greater than DEB_TIME*80ms, the debouncer is reactivated.
- * Default value: 01101[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of deb_time in reg PEDO_DEB_REG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_timeout_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_pedo_deb_reg_t pedo_deb_reg;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_PEDO_DEB_REG,
- (uint8_t *)&pedo_deb_reg, 1);
- if (ret == 0)
- {
- *val = pedo_deb_reg.deb_time;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Time period register for step detection on delta time (r/w).[set]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that contains data to write
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_steps_period_set(stmdev_ctx_t *ctx,
- uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_STEP_COUNT_DELTA, buff, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Time period register for step detection on delta time (r/w).[get]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that stores data read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_pedo_steps_period_get(stmdev_ctx_t *ctx,
- uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_STEP_COUNT_DELTA, buff, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_significant_motion
- * @brief This section groups all the functions that manage the
- * significant motion detection.
- * @{
- *
- */
- /**
- * @brief Enable significant motion detection function.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of sign_motion_en in reg CTRL10_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_motion_sens_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- if (ret == 0)
- {
- ctrl10_c.sign_motion_en = val;
- if (val != 0x00U)
- {
- ctrl10_c.func_en = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- }
- }
- return ret;
- }
- /**
- * @brief Enable significant motion detection function.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of sign_motion_en in reg CTRL10_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_motion_sens_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- *val = ctrl10_c.sign_motion_en;
- return ret;
- }
- /**
- * @brief Significant motion threshold.[set]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that store significant motion threshold.
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_motion_threshold_set(stmdev_ctx_t *ctx,
- uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SM_THS, buff, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Significant motion threshold.[get]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that store significant motion threshold.
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_motion_threshold_get(stmdev_ctx_t *ctx,
- uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SM_THS, buff, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_tilt_detection
- * @brief This section groups all the functions that manage the tilt
- * event detection.
- * @{
- *
- */
- /**
- * @brief Enable tilt calculation.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tilt_en in reg CTRL10_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tilt_sens_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- if (ret == 0)
- {
- ctrl10_c.tilt_en = val;
- if (val != 0x00U)
- {
- ctrl10_c.func_en = val;
- }
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- }
- return ret;
- }
- /**
- * @brief Enable tilt calculation.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tilt_en in reg CTRL10_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tilt_sens_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- *val = ctrl10_c.tilt_en;
- return ret;
- }
- /**
- * @brief Enable tilt calculation.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tilt_en in reg CTRL10_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_wrist_tilt_sens_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- if (ret == 0)
- {
- ctrl10_c.wrist_tilt_en = val;
- if (val != 0x00U)
- {
- ctrl10_c.func_en = val;
- }
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- }
- return ret;
- }
- /**
- * @brief Enable tilt calculation.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tilt_en in reg CTRL10_C
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_wrist_tilt_sens_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- *val = ctrl10_c.wrist_tilt_en;
- return ret;
- }
- /**
- * @brief Absolute Wrist Tilt latency register (r/w).
- * Absolute wrist tilt latency parameters.
- * 1 LSB = 40 ms. Default value: 0Fh (600 ms).[set]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that contains data to write
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tilt_latency_set(stmdev_ctx_t *ctx, uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_B);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_A_WRIST_TILT_LAT, buff, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Absolute Wrist Tilt latency register (r/w).
- * Absolute wrist tilt latency parameters.
- * 1 LSB = 40 ms. Default value: 0Fh (600 ms).[get]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that stores data read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tilt_latency_get(stmdev_ctx_t *ctx, uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_B);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_A_WRIST_TILT_LAT, buff, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Absolute Wrist Tilt threshold register(r/w).
- * Absolute wrist tilt threshold parameters.
- * 1 LSB = 15.625 mg.Default value: 20h (500 mg).[set]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that contains data to write
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tilt_threshold_set(stmdev_ctx_t *ctx,
- uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_B);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_A_WRIST_TILT_THS, buff, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Absolute Wrist Tilt threshold register(r/w).
- * Absolute wrist tilt threshold parameters.
- * 1 LSB = 15.625 mg.Default value: 20h (500 mg).[get]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that stores data read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tilt_threshold_get(stmdev_ctx_t *ctx,
- uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_B);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_A_WRIST_TILT_THS, buff, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Absolute Wrist Tilt mask register (r/w).[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Registers A_WRIST_TILT_MASK
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tilt_src_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_a_wrist_tilt_mask_t *val)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_B);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_A_WRIST_TILT_MASK,
- (uint8_t *) val, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Absolute Wrist Tilt mask register (r/w).[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Registers A_WRIST_TILT_MASK
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_tilt_src_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_a_wrist_tilt_mask_t *val)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_B);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_A_WRIST_TILT_MASK,
- (uint8_t *) val, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_ magnetometer_sensor
- * @brief This section groups all the functions that manage additional
- * magnetometer sensor.
- * @{
- *
- */
- /**
- * @brief Enable soft-iron correction algorithm for magnetometer.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of soft_en in reg CTRL9_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_mag_soft_iron_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_ctrl9_xl_t ctrl9_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- if (ret == 0)
- {
- ctrl9_xl.soft_en = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- }
- return ret;
- }
- /**
- * @brief Enable soft-iron correction algorithm for magnetometer.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of soft_en in reg CTRL9_XL
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_mag_soft_iron_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_ctrl9_xl_t ctrl9_xl;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL9_XL,
- (uint8_t *)&ctrl9_xl, 1);
- *val = ctrl9_xl.soft_en;
- return ret;
- }
- /**
- * @brief Enable hard-iron correction algorithm for magnetometer.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of iron_en in reg MASTER_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_mag_hard_iron_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- if (ret == 0)
- {
- master_config.iron_en = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- if (ret == 0)
- {
- if (val != 0x00U)
- {
- ctrl10_c.func_en = val;
- }
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Enable hard-iron correction algorithm for magnetometer.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of iron_en in reg MASTER_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_mag_hard_iron_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- *val = master_config.iron_en;
- return ret;
- }
- /**
- * @brief Soft iron 3x3 matrix. Value are expressed in sign-module format.
- * (Es. SVVVVVVVb where S is the sign 0/+1/- and V is the value).[set]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that contains data to write
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_mag_soft_iron_mat_set(stmdev_ctx_t *ctx,
- uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MAG_SI_XX, buff, 9);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Soft iron 3x3 matrix. Value are expressed in sign-module format.
- * (Es. SVVVVVVVb where S is the sign 0/+1/- and V is the value).[get]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that stores data read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_mag_soft_iron_mat_get(stmdev_ctx_t *ctx,
- uint8_t *buff)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MAG_SI_XX, buff, 9);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Offset for hard-iron compensation register (r/w). The value is
- * expressed as a 16-bit word in two’s complement.[set]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that contains data to write
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_mag_offset_set(stmdev_ctx_t *ctx, int16_t *val)
- {
- uint8_t buff[6];
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- buff[1] = (uint8_t)((uint16_t)val[0] / 256U);
- buff[0] = (uint8_t)((uint16_t)val[0] - (buff[1] * 256U));
- buff[3] = (uint8_t)((uint16_t)val[1] / 256U);
- buff[2] = (uint8_t)((uint16_t)val[1] - (buff[3] * 256U));
- buff[5] = (uint8_t)((uint16_t)val[2] / 256U);
- buff[4] = (uint8_t)((uint16_t)val[2] - (buff[5] * 256U));
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MAG_OFFX_L, buff, 6);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Offset for hard-iron compensation register(r/w).
- * The value is expressed as a 16-bit word in two’s complement.[get]
- *
- * @param ctx Read / write interface definitions
- * @param buff Buffer that stores data read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_mag_offset_get(stmdev_ctx_t *ctx, int16_t *val)
- {
- uint8_t buff[6];
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MAG_OFFX_L, buff, 6);
- if (ret == 0)
- {
- val[0] = (int16_t)buff[1];
- val[0] = (val[0] * 256) + (int16_t)buff[0];
- val[1] = (int16_t)buff[3];
- val[1] = (val[1] * 256) + (int16_t)buff[2];
- val[2] = (int16_t)buff[5];
- val[2] = (val[2] * 256) + (int16_t)buff[4];
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @defgroup LSM6DS3TR_C_Sensor_hub
- * @brief This section groups all the functions that manage the sensor
- * hub functionality.
- * @{
- *
- */
- /**
- * @brief Enable function.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values func_en
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_func_en_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_ctrl10_c_t ctrl10_c;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- if (ret == 0)
- {
- ctrl10_c.func_en = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_CTRL10_C,
- (uint8_t *)&ctrl10_c, 1);
- }
- return ret;
- }
- /**
- * @brief Sensor synchronization time frame with the step of 500 ms and
- * full range of 5s. Unsigned 8-bit.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tph in reg SENSOR_SYNC_TIME_FRAME
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_sync_sens_frame_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_sensor_sync_time_frame_t sensor_sync_time_frame;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SENSOR_SYNC_TIME_FRAME,
- (uint8_t *)&sensor_sync_time_frame, 1);
- if (ret == 0)
- {
- sensor_sync_time_frame.tph = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SENSOR_SYNC_TIME_FRAME,
- (uint8_t *)&sensor_sync_time_frame, 1);
- }
- return ret;
- }
- /**
- * @brief Sensor synchronization time frame with the step of 500 ms and
- * full range of 5s. Unsigned 8-bit.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of tph in reg SENSOR_SYNC_TIME_FRAME
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_sync_sens_frame_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_sensor_sync_time_frame_t sensor_sync_time_frame;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SENSOR_SYNC_TIME_FRAME,
- (uint8_t *)&sensor_sync_time_frame, 1);
- *val = sensor_sync_time_frame.tph;
- return ret;
- }
- /**
- * @brief Resolution ratio of error code for sensor synchronization.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of rr in reg SENSOR_SYNC_RES_RATIO
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_sync_sens_ratio_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_rr_t val)
- {
- lsm6ds3tr_c_sensor_sync_res_ratio_t sensor_sync_res_ratio;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SENSOR_SYNC_RES_RATIO,
- (uint8_t *)&sensor_sync_res_ratio, 1);
- if (ret == 0)
- {
- sensor_sync_res_ratio.rr = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SENSOR_SYNC_RES_RATIO,
- (uint8_t *)&sensor_sync_res_ratio, 1);
- }
- return ret;
- }
- /**
- * @brief Resolution ratio of error code for sensor synchronization.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of rr in reg SENSOR_SYNC_RES_RATIO
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_sync_sens_ratio_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_rr_t *val)
- {
- lsm6ds3tr_c_sensor_sync_res_ratio_t sensor_sync_res_ratio;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SENSOR_SYNC_RES_RATIO,
- (uint8_t *)&sensor_sync_res_ratio, 1);
- switch (sensor_sync_res_ratio.rr)
- {
- case LSM6DS3TR_C_RES_RATIO_2_11:
- *val = LSM6DS3TR_C_RES_RATIO_2_11;
- break;
- case LSM6DS3TR_C_RES_RATIO_2_12:
- *val = LSM6DS3TR_C_RES_RATIO_2_12;
- break;
- case LSM6DS3TR_C_RES_RATIO_2_13:
- *val = LSM6DS3TR_C_RES_RATIO_2_13;
- break;
- case LSM6DS3TR_C_RES_RATIO_2_14:
- *val = LSM6DS3TR_C_RES_RATIO_2_14;
- break;
- default:
- *val = LSM6DS3TR_C_RES_RATIO_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Sensor hub I2C master enable.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of master_on in reg MASTER_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_master_set(stmdev_ctx_t *ctx, uint8_t val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- if (ret == 0)
- {
- master_config.master_on = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- }
- return ret;
- }
- /**
- * @brief Sensor hub I2C master enable.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of master_on in reg MASTER_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_master_get(stmdev_ctx_t *ctx, uint8_t *val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- *val = master_config.master_on;
- return ret;
- }
- /**
- * @brief I2C interface pass-through.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of pass_through_mode in reg MASTER_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_pass_through_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- if (ret == 0)
- {
- master_config.pass_through_mode = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- }
- return ret;
- }
- /**
- * @brief I2C interface pass-through.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of pass_through_mode in reg MASTER_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_pass_through_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- *val = master_config.pass_through_mode;
- return ret;
- }
- /**
- * @brief Master I2C pull-up enable/disable.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of pull_up_en in reg MASTER_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_pin_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_pull_up_en_t val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- if (ret == 0)
- {
- master_config.pull_up_en = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- }
- return ret;
- }
- /**
- * @brief Master I2C pull-up enable/disable.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of pull_up_en in reg MASTER_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_pin_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_pull_up_en_t *val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- switch (master_config.pull_up_en)
- {
- case LSM6DS3TR_C_EXT_PULL_UP:
- *val = LSM6DS3TR_C_EXT_PULL_UP;
- break;
- case LSM6DS3TR_C_INTERNAL_PULL_UP:
- *val = LSM6DS3TR_C_INTERNAL_PULL_UP;
- break;
- default:
- *val = LSM6DS3TR_C_SH_PIN_MODE;
- break;
- }
- return ret;
- }
- /**
- * @brief Sensor hub trigger signal selection.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of start_config in reg MASTER_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_syncro_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_start_config_t val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- if (ret == 0)
- {
- master_config.start_config = (uint8_t)val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- }
- return ret;
- }
- /**
- * @brief Sensor hub trigger signal selection.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of start_config in reg MASTER_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_syncro_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_start_config_t *val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- switch (master_config.start_config)
- {
- case LSM6DS3TR_C_XL_GY_DRDY:
- *val = LSM6DS3TR_C_XL_GY_DRDY;
- break;
- case LSM6DS3TR_C_EXT_ON_INT2_PIN:
- *val = LSM6DS3TR_C_EXT_ON_INT2_PIN;
- break;
- default:
- *val = LSM6DS3TR_C_SH_SYNCRO_ND;
- break;
- }
- return ret;
- }
- /**
- * @brief Manage the Master DRDY signal on INT1 pad.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of drdy_on_int1 in reg MASTER_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_drdy_on_int1_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- if (ret == 0)
- {
- master_config.drdy_on_int1 = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- }
- return ret;
- }
- /**
- * @brief Manage the Master DRDY signal on INT1 pad.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of drdy_on_int1 in reg MASTER_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_drdy_on_int1_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_master_config_t master_config;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CONFIG,
- (uint8_t *)&master_config, 1);
- *val = master_config.drdy_on_int1;
- return ret;
- }
- /**
- * @brief Sensor hub output registers.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Structure of registers from SENSORHUB1_REG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_read_data_raw_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_emb_sh_read_t *val)
- {
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SENSORHUB1_REG,
- (uint8_t *) & (val->sh_byte_1), 12);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SENSORHUB13_REG,
- (uint8_t *) & (val->sh_byte_13), 6);
- }
- return ret;
- }
- /**
- * @brief Master command code used for stamping for sensor sync.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of master_cmd_code in
- * reg MASTER_CMD_CODE
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_cmd_sens_sync_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_master_cmd_code_t master_cmd_code;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CMD_CODE,
- (uint8_t *)&master_cmd_code, 1);
- if (ret == 0)
- {
- master_cmd_code.master_cmd_code = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_MASTER_CMD_CODE,
- (uint8_t *)&master_cmd_code, 1);
- }
- return ret;
- }
- /**
- * @brief Master command code used for stamping for sensor sync.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of master_cmd_code in
- * reg MASTER_CMD_CODE
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_cmd_sens_sync_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_master_cmd_code_t master_cmd_code;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_MASTER_CMD_CODE,
- (uint8_t *)&master_cmd_code, 1);
- *val = master_cmd_code.master_cmd_code;
- return ret;
- }
- /**
- * @brief Error code used for sensor synchronization.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of error_code in
- * reg SENS_SYNC_SPI_ERROR_CODE.
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_spi_sync_error_set(stmdev_ctx_t *ctx,
- uint8_t val)
- {
- lsm6ds3tr_c_sens_sync_spi_error_code_t sens_sync_spi_error_code;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SENS_SYNC_SPI_ERROR_CODE,
- (uint8_t *)&sens_sync_spi_error_code, 1);
- if (ret == 0)
- {
- sens_sync_spi_error_code.error_code = val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SENS_SYNC_SPI_ERROR_CODE,
- (uint8_t *)&sens_sync_spi_error_code, 1);
- }
- return ret;
- }
- /**
- * @brief Error code used for sensor synchronization.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of error_code in
- * reg SENS_SYNC_SPI_ERROR_CODE.
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_spi_sync_error_get(stmdev_ctx_t *ctx,
- uint8_t *val)
- {
- lsm6ds3tr_c_sens_sync_spi_error_code_t sens_sync_spi_error_code;
- int32_t ret;
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SENS_SYNC_SPI_ERROR_CODE,
- (uint8_t *)&sens_sync_spi_error_code, 1);
- *val = sens_sync_spi_error_code.error_code;
- return ret;
- }
- /**
- * @brief Number of external sensors to be read by the sensor hub.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of aux_sens_on in reg SLAVE0_CONFIG.
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_num_of_dev_connected_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_aux_sens_on_t val)
- {
- lsm6ds3tr_c_slave0_config_t slave0_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE0_CONFIG,
- (uint8_t *)&slave0_config, 1);
- if (ret == 0)
- {
- slave0_config.aux_sens_on = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLAVE0_CONFIG,
- (uint8_t *)&slave0_config, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Number of external sensors to be read by the sensor hub.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of aux_sens_on in reg SLAVE0_CONFIG.
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_num_of_dev_connected_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_aux_sens_on_t *val)
- {
- lsm6ds3tr_c_slave0_config_t slave0_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE0_CONFIG,
- (uint8_t *)&slave0_config, 1);
- if (ret == 0)
- {
- switch (slave0_config.aux_sens_on)
- {
- case LSM6DS3TR_C_SLV_0:
- *val = LSM6DS3TR_C_SLV_0;
- break;
- case LSM6DS3TR_C_SLV_0_1:
- *val = LSM6DS3TR_C_SLV_0_1;
- break;
- case LSM6DS3TR_C_SLV_0_1_2:
- *val = LSM6DS3TR_C_SLV_0_1_2;
- break;
- case LSM6DS3TR_C_SLV_0_1_2_3:
- *val = LSM6DS3TR_C_SLV_0_1_2_3;
- break;
- default:
- *val = LSM6DS3TR_C_SLV_EN_ND;
- break;
- }
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Configure slave 0 for perform a write.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Structure that contain:
- * - uint8_t slv_add; 8 bit i2c device address
- * - uint8_t slv_subadd; 8 bit register device address
- * - uint8_t slv_data; 8 bit data to write
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_cfg_write(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_sh_cfg_write_t *val)
- {
- lsm6ds3tr_c_slv0_add_t slv0_add;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- slv0_add.slave0_add = val->slv0_add;
- slv0_add.rw_0 = 0;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLV0_ADD,
- (uint8_t *)&slv0_add, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLV0_SUBADD,
- &(val->slv0_subadd), 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx,
- LSM6DS3TR_C_DATAWRITE_SRC_MODE_SUB_SLV0,
- &(val->slv0_data), 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- }
- return ret;
- }
- /**
- * @brief Configure slave 0 for perform a read.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Structure that contain:
- * - uint8_t slv_add; 8 bit i2c device address
- * - uint8_t slv_subadd; 8 bit register device address
- * - uint8_t slv_len; num of bit to read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_slv0_cfg_read(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_sh_cfg_read_t *val)
- {
- lsm6ds3tr_c_slave0_config_t slave0_config;
- lsm6ds3tr_c_slv0_add_t slv0_add;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- slv0_add.slave0_add = val->slv_add;
- slv0_add.rw_0 = 1;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLV0_ADD,
- (uint8_t *)&slv0_add, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLV0_SUBADD,
- &(val->slv_subadd), 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE0_CONFIG,
- (uint8_t *)&slave0_config, 1);
- slave0_config.slave0_numop = val->slv_len;
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLAVE0_CONFIG,
- (uint8_t *)&slave0_config, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- }
- }
- return ret;
- }
- /**
- * @brief Configure slave 1 for perform a read.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Structure that contain:
- * - uint8_t slv_add; 8 bit i2c device address
- * - uint8_t slv_subadd; 8 bit register device address
- * - uint8_t slv_len; num of bit to read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_slv1_cfg_read(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_sh_cfg_read_t *val)
- {
- lsm6ds3tr_c_slave1_config_t slave1_config;
- lsm6ds3tr_c_slv1_add_t slv1_add;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- slv1_add.slave1_add = val->slv_add;
- slv1_add.r_1 = 1;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLV1_ADD,
- (uint8_t *)&slv1_add, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLV1_SUBADD,
- &(val->slv_subadd), 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE1_CONFIG,
- (uint8_t *)&slave1_config, 1);
- slave1_config.slave1_numop = val->slv_len;
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLAVE1_CONFIG,
- (uint8_t *)&slave1_config, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- }
- }
- return ret;
- }
- /**
- * @brief Configure slave 2 for perform a read.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Structure that contain:
- * - uint8_t slv_add; 8 bit i2c device address
- * - uint8_t slv_subadd; 8 bit register device address
- * - uint8_t slv_len; num of bit to read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_slv2_cfg_read(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_sh_cfg_read_t *val)
- {
- lsm6ds3tr_c_slv2_add_t slv2_add;
- lsm6ds3tr_c_slave2_config_t slave2_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- slv2_add.slave2_add = val->slv_add;
- slv2_add.r_2 = 1;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLV2_ADD,
- (uint8_t *)&slv2_add, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLV2_SUBADD,
- &(val->slv_subadd), 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE2_CONFIG,
- (uint8_t *)&slave2_config, 1);
- if (ret == 0)
- {
- slave2_config.slave2_numop = val->slv_len;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLAVE2_CONFIG,
- (uint8_t *)&slave2_config, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- }
- }
- return ret;
- }
- /**
- * @brief Configure slave 3 for perform a read.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Structure that contain:
- * - uint8_t slv_add; 8 bit i2c device address
- * - uint8_t slv_subadd; 8 bit register device address
- * - uint8_t slv_len; num of bit to read
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_slv3_cfg_read(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_sh_cfg_read_t *val)
- {
- lsm6ds3tr_c_slave3_config_t slave3_config;
- lsm6ds3tr_c_slv3_add_t slv3_add;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- slv3_add.slave3_add = val->slv_add;
- slv3_add.r_3 = 1;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLV3_ADD,
- (uint8_t *)&slv3_add, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLV3_SUBADD,
- (uint8_t *) & (val->slv_subadd), 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE3_CONFIG,
- (uint8_t *)&slave3_config, 1);
- if (ret == 0)
- {
- slave3_config.slave3_numop = val->slv_len;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLAVE3_CONFIG,
- (uint8_t *)&slave3_config, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- }
- }
- return ret;
- }
- /**
- * @brief Decimation of read operation on Slave 0 starting from the
- * sensor hub trigger.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of slave0_rate in reg SLAVE0_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_slave_0_dec_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_slave0_rate_t val)
- {
- lsm6ds3tr_c_slave0_config_t slave0_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE0_CONFIG,
- (uint8_t *)&slave0_config, 1);
- if (ret == 0)
- {
- slave0_config.slave0_rate = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLAVE0_CONFIG,
- (uint8_t *)&slave0_config, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Decimation of read operation on Slave 0 starting from the
- * sensor hub trigger.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of slave0_rate in reg SLAVE0_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_slave_0_dec_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_slave0_rate_t *val)
- {
- lsm6ds3tr_c_slave0_config_t slave0_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE0_CONFIG,
- (uint8_t *)&slave0_config, 1);
- if (ret == 0)
- {
- switch (slave0_config.slave0_rate)
- {
- case LSM6DS3TR_C_SL0_NO_DEC:
- *val = LSM6DS3TR_C_SL0_NO_DEC;
- break;
- case LSM6DS3TR_C_SL0_DEC_2:
- *val = LSM6DS3TR_C_SL0_DEC_2;
- break;
- case LSM6DS3TR_C_SL0_DEC_4:
- *val = LSM6DS3TR_C_SL0_DEC_4;
- break;
- case LSM6DS3TR_C_SL0_DEC_8:
- *val = LSM6DS3TR_C_SL0_DEC_8;
- break;
- default:
- *val = LSM6DS3TR_C_SL0_DEC_ND;
- break;
- }
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Slave 0 write operation is performed only at the first sensor
- * hub cycle.
- * This is effective if the Aux_sens_on[1:0] field in
- * SLAVE0_CONFIG(04h) is set to a value other than 00.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of write_once in reg SLAVE1_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_write_mode_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_write_once_t val)
- {
- lsm6ds3tr_c_slave1_config_t slave1_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE1_CONFIG,
- (uint8_t *)&slave1_config, 1);
- slave1_config.write_once = (uint8_t) val;
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLAVE1_CONFIG,
- (uint8_t *)&slave1_config, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Slave 0 write operation is performed only at the first sensor
- * hub cycle.
- * This is effective if the Aux_sens_on[1:0] field in
- * SLAVE0_CONFIG(04h) is set to a value other than 00.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of write_once in reg SLAVE1_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_write_mode_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_write_once_t *val)
- {
- lsm6ds3tr_c_slave1_config_t slave1_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE1_CONFIG,
- (uint8_t *)&slave1_config, 1);
- if (ret == 0)
- {
- switch (slave1_config.write_once)
- {
- case LSM6DS3TR_C_EACH_SH_CYCLE:
- *val = LSM6DS3TR_C_EACH_SH_CYCLE;
- break;
- case LSM6DS3TR_C_ONLY_FIRST_CYCLE:
- *val = LSM6DS3TR_C_ONLY_FIRST_CYCLE;
- break;
- default:
- *val = LSM6DS3TR_C_SH_WR_MODE_ND;
- break;
- }
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Decimation of read operation on Slave 1 starting from the
- * sensor hub trigger.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of slave1_rate in reg SLAVE1_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_slave_1_dec_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_slave1_rate_t val)
- {
- lsm6ds3tr_c_slave1_config_t slave1_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE1_CONFIG,
- (uint8_t *)&slave1_config, 1);
- if (ret == 0)
- {
- slave1_config.slave1_rate = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLAVE1_CONFIG,
- (uint8_t *)&slave1_config, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Decimation of read operation on Slave 1 starting from the
- * sensor hub trigger.[get]
- *
- * @param ctx Read / write interface definitions reg SLAVE1_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_slave_1_dec_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_slave1_rate_t *val)
- {
- lsm6ds3tr_c_slave1_config_t slave1_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE1_CONFIG,
- (uint8_t *)&slave1_config, 1);
- if (ret == 0)
- {
- switch (slave1_config.slave1_rate)
- {
- case LSM6DS3TR_C_SL1_NO_DEC:
- *val = LSM6DS3TR_C_SL1_NO_DEC;
- break;
- case LSM6DS3TR_C_SL1_DEC_2:
- *val = LSM6DS3TR_C_SL1_DEC_2;
- break;
- case LSM6DS3TR_C_SL1_DEC_4:
- *val = LSM6DS3TR_C_SL1_DEC_4;
- break;
- case LSM6DS3TR_C_SL1_DEC_8:
- *val = LSM6DS3TR_C_SL1_DEC_8;
- break;
- default:
- *val = LSM6DS3TR_C_SL1_DEC_ND;
- break;
- }
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Decimation of read operation on Slave 2 starting from the
- * sensor hub trigger.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of slave2_rate in reg SLAVE2_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_slave_2_dec_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_slave2_rate_t val)
- {
- lsm6ds3tr_c_slave2_config_t slave2_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE2_CONFIG,
- (uint8_t *)&slave2_config, 1);
- if (ret == 0)
- {
- slave2_config.slave2_rate = (uint8_t) val;
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLAVE2_CONFIG,
- (uint8_t *)&slave2_config, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Decimation of read operation on Slave 2 starting from the
- * sensor hub trigger.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of slave2_rate in reg SLAVE2_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_slave_2_dec_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_slave2_rate_t *val)
- {
- lsm6ds3tr_c_slave2_config_t slave2_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE2_CONFIG,
- (uint8_t *)&slave2_config, 1);
- if (ret == 0)
- {
- switch (slave2_config.slave2_rate)
- {
- case LSM6DS3TR_C_SL2_NO_DEC:
- *val = LSM6DS3TR_C_SL2_NO_DEC;
- break;
- case LSM6DS3TR_C_SL2_DEC_2:
- *val = LSM6DS3TR_C_SL2_DEC_2;
- break;
- case LSM6DS3TR_C_SL2_DEC_4:
- *val = LSM6DS3TR_C_SL2_DEC_4;
- break;
- case LSM6DS3TR_C_SL2_DEC_8:
- *val = LSM6DS3TR_C_SL2_DEC_8;
- break;
- default:
- *val = LSM6DS3TR_C_SL2_DEC_ND;
- break;
- }
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @brief Decimation of read operation on Slave 3 starting from the
- * sensor hub trigger.[set]
- *
- * @param ctx Read / write interface definitions
- * @param val Change the values of slave3_rate in reg SLAVE3_CONFIG
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_slave_3_dec_set(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_slave3_rate_t val)
- {
- lsm6ds3tr_c_slave3_config_t slave3_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE3_CONFIG,
- (uint8_t *)&slave3_config, 1);
- slave3_config.slave3_rate = (uint8_t)val;
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_write_reg(ctx, LSM6DS3TR_C_SLAVE3_CONFIG,
- (uint8_t *)&slave3_config, 1);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- }
- return ret;
- }
- /**
- * @brief Decimation of read operation on Slave 3 starting from the
- * sensor hub trigger.[get]
- *
- * @param ctx Read / write interface definitions
- * @param val Get the values of slave3_rate in reg SLAVE3_CONFIG.
- * @retval Interface status (MANDATORY: return 0 -> no Error).
- *
- */
- int32_t lsm6ds3tr_c_sh_slave_3_dec_get(stmdev_ctx_t *ctx,
- lsm6ds3tr_c_slave3_rate_t *val)
- {
- lsm6ds3tr_c_slave3_config_t slave3_config;
- int32_t ret;
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_BANK_A);
- if (ret == 0)
- {
- ret = lsm6ds3tr_c_read_reg(ctx, LSM6DS3TR_C_SLAVE3_CONFIG,
- (uint8_t *)&slave3_config, 1);
- if (ret == 0)
- {
- switch (slave3_config.slave3_rate)
- {
- case LSM6DS3TR_C_SL3_NO_DEC:
- *val = LSM6DS3TR_C_SL3_NO_DEC;
- break;
- case LSM6DS3TR_C_SL3_DEC_2:
- *val = LSM6DS3TR_C_SL3_DEC_2;
- break;
- case LSM6DS3TR_C_SL3_DEC_4:
- *val = LSM6DS3TR_C_SL3_DEC_4;
- break;
- case LSM6DS3TR_C_SL3_DEC_8:
- *val = LSM6DS3TR_C_SL3_DEC_8;
- break;
- default:
- *val = LSM6DS3TR_C_SL3_DEC_ND;
- break;
- }
- ret = lsm6ds3tr_c_mem_bank_set(ctx, LSM6DS3TR_C_USER_BANK);
- }
- }
- return ret;
- }
- /**
- * @}
- *
- */
- /**
- * @}
- *
- */
- /************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
|