1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264426542664267426842694270427142724273427442754276427742784279428042814282428342844285428642874288428942904291429242934294429542964297429842994300430143024303430443054306430743084309431043114312431343144315431643174318431943204321432243234324432543264327432843294330433143324333433443354336433743384339434043414342434343444345434643474348434943504351435243534354435543564357435843594360436143624363436443654366436743684369437043714372437343744375437643774378437943804381438243834384438543864387438843894390439143924393439443954396439743984399440044014402440344044405440644074408440944104411441244134414441544164417441844194420442144224423442444254426442744284429443044314432443344344435443644374438443944404441444244434444444544464447444844494450445144524453445444554456445744584459446044614462446344644465446644674468446944704471447244734474447544764477447844794480448144824483448444854486448744884489449044914492449344944495449644974498449945004501450245034504450545064507450845094510451145124513451445154516451745184519452045214522452345244525452645274528452945304531453245334534453545364537453845394540454145424543454445454546454745484549455045514552455345544555455645574558455945604561456245634564456545664567456845694570457145724573457445754576457745784579458045814582458345844585458645874588458945904591459245934594459545964597459845994600460146024603460446054606460746084609461046114612461346144615461646174618461946204621462246234624462546264627462846294630463146324633463446354636463746384639464046414642464346444645464646474648464946504651465246534654465546564657465846594660466146624663466446654666466746684669467046714672467346744675467646774678467946804681468246834684468546864687468846894690469146924693469446954696469746984699470047014702470347044705470647074708470947104711471247134714471547164717471847194720472147224723472447254726472747284729473047314732473347344735473647374738473947404741474247434744474547464747474847494750475147524753475447554756475747584759476047614762476347644765476647674768476947704771477247734774477547764777477847794780478147824783478447854786478747884789479047914792479347944795479647974798479948004801480248034804480548064807480848094810481148124813481448154816481748184819482048214822482348244825482648274828482948304831483248334834483548364837483848394840484148424843484448454846484748484849485048514852485348544855485648574858485948604861486248634864486548664867486848694870487148724873487448754876487748784879488048814882488348844885488648874888488948904891489248934894489548964897489848994900490149024903490449054906490749084909491049114912491349144915491649174918491949204921492249234924492549264927492849294930493149324933493449354936493749384939494049414942494349444945494649474948494949504951495249534954495549564957495849594960496149624963496449654966496749684969497049714972497349744975497649774978497949804981498249834984498549864987498849894990499149924993499449954996499749984999500050015002500350045005500650075008500950105011501250135014501550165017501850195020502150225023502450255026502750285029503050315032503350345035503650375038503950405041504250435044504550465047504850495050505150525053505450555056505750585059506050615062506350645065506650675068506950705071507250735074507550765077507850795080508150825083508450855086508750885089509050915092509350945095509650975098509951005101510251035104510551065107510851095110511151125113511451155116511751185119512051215122512351245125512651275128512951305131513251335134513551365137513851395140514151425143514451455146514751485149515051515152515351545155515651575158515951605161516251635164516551665167516851695170517151725173517451755176517751785179518051815182518351845185518651875188518951905191519251935194519551965197519851995200520152025203520452055206520752085209521052115212521352145215521652175218521952205221522252235224522552265227522852295230523152325233523452355236523752385239524052415242524352445245524652475248524952505251525252535254525552565257525852595260526152625263526452655266526752685269527052715272527352745275527652775278527952805281528252835284528552865287528852895290529152925293529452955296529752985299530053015302530353045305530653075308530953105311531253135314531553165317531853195320532153225323532453255326532753285329533053315332533353345335533653375338533953405341534253435344534553465347534853495350535153525353535453555356535753585359536053615362536353645365536653675368536953705371537253735374537553765377537853795380538153825383538453855386538753885389539053915392539353945395539653975398539954005401540254035404540554065407540854095410541154125413541454155416541754185419542054215422542354245425542654275428542954305431543254335434543554365437543854395440544154425443544454455446544754485449545054515452545354545455545654575458545954605461546254635464546554665467546854695470547154725473547454755476547754785479548054815482548354845485548654875488548954905491549254935494549554965497549854995500550155025503550455055506550755085509551055115512551355145515551655175518551955205521552255235524552555265527552855295530553155325533553455355536553755385539554055415542554355445545554655475548554955505551555255535554555555565557555855595560556155625563556455655566556755685569557055715572557355745575557655775578557955805581558255835584558555865587558855895590559155925593559455955596559755985599560056015602560356045605560656075608560956105611561256135614561556165617561856195620562156225623562456255626562756285629563056315632563356345635563656375638563956405641564256435644564556465647564856495650565156525653565456555656565756585659566056615662566356645665566656675668566956705671567256735674567556765677567856795680568156825683568456855686568756885689569056915692569356945695569656975698569957005701570257035704570557065707570857095710571157125713571457155716571757185719572057215722572357245725572657275728572957305731573257335734573557365737573857395740574157425743574457455746574757485749575057515752575357545755575657575758575957605761576257635764576557665767576857695770577157725773577457755776577757785779578057815782578357845785578657875788578957905791579257935794579557965797579857995800580158025803580458055806580758085809581058115812581358145815581658175818581958205821582258235824582558265827582858295830583158325833583458355836583758385839584058415842584358445845584658475848584958505851585258535854585558565857585858595860586158625863586458655866586758685869587058715872587358745875587658775878587958805881588258835884588558865887588858895890589158925893589458955896589758985899590059015902590359045905590659075908590959105911591259135914591559165917591859195920592159225923592459255926592759285929593059315932593359345935593659375938593959405941594259435944594559465947594859495950595159525953595459555956595759585959596059615962596359645965596659675968596959705971597259735974597559765977597859795980598159825983598459855986598759885989599059915992599359945995599659975998599960006001600260036004600560066007600860096010601160126013601460156016601760186019602060216022602360246025602660276028602960306031603260336034603560366037603860396040604160426043604460456046604760486049605060516052605360546055605660576058605960606061606260636064606560666067606860696070607160726073607460756076607760786079608060816082608360846085608660876088608960906091609260936094609560966097609860996100610161026103610461056106610761086109611061116112611361146115611661176118611961206121612261236124612561266127612861296130613161326133613461356136613761386139614061416142614361446145614661476148614961506151615261536154615561566157615861596160616161626163616461656166616761686169617061716172617361746175617661776178617961806181618261836184618561866187618861896190619161926193619461956196619761986199620062016202620362046205620662076208620962106211621262136214621562166217621862196220622162226223622462256226622762286229623062316232623362346235623662376238623962406241624262436244624562466247624862496250625162526253625462556256625762586259626062616262626362646265626662676268626962706271627262736274627562766277627862796280628162826283628462856286628762886289629062916292629362946295629662976298629963006301630263036304630563066307630863096310631163126313631463156316631763186319632063216322632363246325632663276328632963306331633263336334633563366337633863396340634163426343634463456346634763486349635063516352635363546355635663576358635963606361636263636364636563666367636863696370637163726373637463756376637763786379638063816382638363846385638663876388638963906391639263936394639563966397639863996400640164026403640464056406640764086409641064116412641364146415641664176418641964206421642264236424642564266427642864296430643164326433643464356436643764386439644064416442644364446445644664476448644964506451645264536454645564566457645864596460646164626463646464656466646764686469647064716472647364746475647664776478647964806481648264836484648564866487648864896490649164926493649464956496649764986499650065016502650365046505650665076508650965106511651265136514651565166517651865196520652165226523652465256526652765286529653065316532653365346535653665376538653965406541654265436544654565466547654865496550655165526553655465556556655765586559656065616562656365646565656665676568656965706571657265736574657565766577657865796580658165826583658465856586658765886589659065916592659365946595659665976598659966006601660266036604660566066607660866096610661166126613661466156616661766186619662066216622662366246625662666276628662966306631663266336634663566366637663866396640664166426643664466456646664766486649665066516652665366546655665666576658665966606661666266636664666566666667666866696670667166726673667466756676667766786679668066816682668366846685668666876688668966906691669266936694669566966697669866996700670167026703670467056706670767086709671067116712671367146715671667176718671967206721672267236724672567266727672867296730673167326733673467356736673767386739674067416742674367446745674667476748674967506751675267536754675567566757675867596760676167626763676467656766676767686769677067716772677367746775677667776778677967806781678267836784678567866787678867896790679167926793679467956796679767986799680068016802680368046805680668076808680968106811681268136814681568166817681868196820682168226823682468256826682768286829683068316832683368346835683668376838683968406841684268436844684568466847684868496850685168526853685468556856685768586859686068616862686368646865686668676868686968706871687268736874687568766877687868796880688168826883688468856886688768886889689068916892689368946895689668976898689969006901690269036904690569066907690869096910691169126913691469156916691769186919692069216922692369246925692669276928692969306931693269336934693569366937693869396940694169426943694469456946694769486949695069516952695369546955695669576958695969606961696269636964696569666967696869696970697169726973697469756976697769786979698069816982698369846985698669876988698969906991699269936994699569966997699869997000700170027003700470057006700770087009701070117012701370147015701670177018701970207021702270237024702570267027702870297030703170327033703470357036703770387039704070417042704370447045704670477048704970507051705270537054705570567057705870597060706170627063706470657066706770687069707070717072707370747075707670777078707970807081708270837084708570867087708870897090709170927093709470957096709770987099710071017102710371047105710671077108710971107111711271137114711571167117711871197120712171227123712471257126712771287129713071317132713371347135713671377138713971407141714271437144714571467147714871497150715171527153715471557156715771587159716071617162716371647165716671677168716971707171717271737174717571767177717871797180718171827183718471857186718771887189719071917192719371947195719671977198719972007201720272037204720572067207720872097210721172127213721472157216721772187219722072217222722372247225722672277228722972307231723272337234723572367237723872397240724172427243724472457246724772487249725072517252725372547255725672577258725972607261726272637264726572667267726872697270727172727273727472757276727772787279728072817282728372847285728672877288728972907291729272937294729572967297729872997300730173027303730473057306730773087309731073117312731373147315731673177318731973207321732273237324732573267327732873297330733173327333733473357336733773387339734073417342734373447345734673477348734973507351735273537354735573567357735873597360736173627363736473657366736773687369737073717372737373747375737673777378737973807381738273837384738573867387738873897390739173927393739473957396739773987399740074017402740374047405740674077408740974107411741274137414741574167417741874197420742174227423742474257426742774287429743074317432743374347435743674377438743974407441744274437444744574467447744874497450745174527453745474557456745774587459746074617462746374647465746674677468746974707471747274737474747574767477747874797480748174827483748474857486748774887489749074917492749374947495749674977498749975007501750275037504750575067507750875097510751175127513751475157516751775187519752075217522752375247525752675277528752975307531753275337534753575367537753875397540754175427543754475457546754775487549755075517552755375547555755675577558755975607561756275637564756575667567756875697570757175727573757475757576757775787579758075817582758375847585758675877588758975907591759275937594759575967597759875997600760176027603760476057606760776087609761076117612761376147615761676177618761976207621762276237624762576267627762876297630763176327633763476357636763776387639764076417642764376447645764676477648764976507651765276537654765576567657765876597660766176627663766476657666766776687669767076717672767376747675767676777678767976807681768276837684768576867687768876897690769176927693769476957696769776987699770077017702770377047705770677077708770977107711771277137714771577167717771877197720772177227723772477257726772777287729773077317732773377347735773677377738773977407741774277437744774577467747774877497750775177527753775477557756775777587759776077617762776377647765776677677768776977707771777277737774777577767777777877797780778177827783778477857786778777887789779077917792779377947795779677977798779978007801780278037804780578067807780878097810781178127813781478157816781778187819782078217822782378247825782678277828782978307831783278337834783578367837783878397840784178427843784478457846784778487849785078517852785378547855785678577858785978607861786278637864786578667867786878697870787178727873787478757876787778787879788078817882788378847885788678877888788978907891789278937894789578967897789878997900790179027903790479057906790779087909791079117912791379147915791679177918791979207921792279237924792579267927792879297930793179327933793479357936793779387939794079417942794379447945794679477948794979507951795279537954795579567957795879597960796179627963796479657966796779687969797079717972797379747975797679777978797979807981798279837984798579867987798879897990799179927993799479957996799779987999800080018002800380048005800680078008800980108011801280138014801580168017801880198020802180228023802480258026802780288029803080318032803380348035803680378038803980408041804280438044804580468047804880498050805180528053805480558056805780588059806080618062806380648065806680678068806980708071807280738074807580768077807880798080808180828083808480858086808780888089809080918092809380948095809680978098809981008101810281038104810581068107810881098110811181128113811481158116811781188119812081218122812381248125812681278128812981308131813281338134813581368137813881398140814181428143814481458146814781488149815081518152815381548155815681578158815981608161816281638164816581668167816881698170817181728173817481758176817781788179818081818182818381848185818681878188818981908191819281938194819581968197819881998200820182028203820482058206820782088209821082118212821382148215821682178218821982208221822282238224822582268227822882298230823182328233823482358236823782388239824082418242824382448245824682478248824982508251825282538254825582568257825882598260826182628263826482658266826782688269827082718272827382748275827682778278827982808281828282838284828582868287828882898290829182928293829482958296829782988299830083018302830383048305830683078308830983108311831283138314831583168317831883198320832183228323832483258326832783288329833083318332833383348335833683378338833983408341834283438344834583468347834883498350835183528353835483558356835783588359836083618362836383648365836683678368836983708371837283738374837583768377837883798380838183828383838483858386838783888389839083918392839383948395839683978398839984008401840284038404840584068407840884098410841184128413841484158416841784188419842084218422842384248425842684278428842984308431843284338434843584368437843884398440844184428443844484458446844784488449845084518452845384548455845684578458845984608461846284638464846584668467846884698470847184728473847484758476847784788479848084818482848384848485848684878488848984908491849284938494849584968497849884998500850185028503850485058506850785088509851085118512851385148515851685178518851985208521852285238524852585268527852885298530853185328533853485358536853785388539854085418542854385448545854685478548854985508551855285538554855585568557855885598560856185628563856485658566856785688569857085718572857385748575857685778578857985808581858285838584858585868587858885898590859185928593859485958596859785988599860086018602860386048605860686078608860986108611861286138614861586168617861886198620862186228623862486258626862786288629863086318632863386348635863686378638863986408641864286438644864586468647864886498650865186528653865486558656865786588659866086618662866386648665866686678668866986708671867286738674867586768677867886798680868186828683868486858686868786888689869086918692869386948695869686978698869987008701870287038704870587068707870887098710871187128713871487158716871787188719872087218722872387248725872687278728872987308731873287338734873587368737873887398740874187428743874487458746874787488749875087518752875387548755875687578758875987608761876287638764876587668767876887698770877187728773877487758776877787788779878087818782878387848785878687878788878987908791879287938794879587968797879887998800880188028803880488058806880788088809881088118812881388148815881688178818881988208821882288238824882588268827882888298830883188328833883488358836883788388839884088418842884388448845884688478848884988508851885288538854885588568857885888598860886188628863886488658866886788688869887088718872887388748875887688778878887988808881888288838884888588868887888888898890889188928893889488958896889788988899890089018902890389048905890689078908890989108911891289138914891589168917891889198920892189228923892489258926892789288929893089318932893389348935893689378938893989408941894289438944894589468947894889498950895189528953895489558956895789588959896089618962896389648965896689678968896989708971897289738974897589768977897889798980898189828983898489858986898789888989899089918992899389948995899689978998899990009001900290039004900590069007900890099010901190129013901490159016901790189019902090219022902390249025902690279028902990309031903290339034903590369037903890399040904190429043904490459046904790489049905090519052905390549055905690579058905990609061906290639064906590669067906890699070907190729073907490759076907790789079908090819082908390849085908690879088908990909091909290939094909590969097909890999100910191029103910491059106910791089109911091119112911391149115911691179118911991209121912291239124912591269127912891299130913191329133913491359136913791389139914091419142914391449145914691479148914991509151915291539154915591569157915891599160916191629163916491659166916791689169917091719172917391749175917691779178917991809181918291839184918591869187918891899190919191929193919491959196919791989199920092019202920392049205920692079208920992109211921292139214921592169217921892199220922192229223922492259226922792289229923092319232923392349235923692379238923992409241924292439244924592469247924892499250925192529253925492559256925792589259926092619262926392649265926692679268926992709271927292739274927592769277927892799280928192829283928492859286928792889289929092919292929392949295929692979298929993009301930293039304930593069307930893099310931193129313931493159316931793189319932093219322932393249325932693279328932993309331933293339334933593369337933893399340934193429343934493459346934793489349935093519352935393549355935693579358935993609361936293639364936593669367936893699370937193729373937493759376937793789379938093819382938393849385938693879388938993909391939293939394939593969397939893999400940194029403940494059406940794089409941094119412941394149415941694179418941994209421942294239424942594269427942894299430943194329433943494359436943794389439944094419442944394449445944694479448944994509451945294539454945594569457945894599460946194629463946494659466946794689469947094719472947394749475947694779478947994809481948294839484948594869487948894899490949194929493949494959496949794989499950095019502950395049505950695079508950995109511951295139514951595169517951895199520952195229523952495259526952795289529953095319532953395349535953695379538953995409541954295439544954595469547954895499550955195529553955495559556955795589559956095619562956395649565956695679568956995709571957295739574957595769577957895799580958195829583958495859586958795889589959095919592959395949595959695979598959996009601960296039604960596069607960896099610961196129613961496159616961796189619962096219622962396249625962696279628962996309631963296339634963596369637963896399640964196429643964496459646964796489649965096519652965396549655965696579658965996609661966296639664966596669667966896699670967196729673967496759676967796789679968096819682968396849685968696879688968996909691969296939694969596969697969896999700970197029703970497059706970797089709971097119712971397149715971697179718971997209721972297239724972597269727972897299730973197329733973497359736973797389739974097419742974397449745974697479748974997509751975297539754975597569757975897599760976197629763976497659766976797689769977097719772977397749775977697779778977997809781978297839784978597869787978897899790979197929793979497959796979797989799980098019802980398049805980698079808980998109811981298139814981598169817981898199820982198229823982498259826982798289829983098319832983398349835983698379838983998409841984298439844984598469847984898499850985198529853985498559856985798589859986098619862986398649865986698679868986998709871987298739874987598769877987898799880988198829883988498859886988798889889989098919892989398949895989698979898989999009901990299039904990599069907990899099910991199129913991499159916991799189919992099219922992399249925992699279928992999309931993299339934993599369937993899399940994199429943994499459946994799489949995099519952995399549955995699579958995999609961996299639964996599669967996899699970997199729973997499759976997799789979998099819982998399849985998699879988998999909991999299939994999599969997999899991000010001100021000310004100051000610007100081000910010100111001210013100141001510016100171001810019100201002110022100231002410025100261002710028100291003010031100321003310034100351003610037100381003910040100411004210043100441004510046100471004810049100501005110052100531005410055100561005710058100591006010061100621006310064100651006610067100681006910070100711007210073100741007510076100771007810079100801008110082100831008410085100861008710088100891009010091100921009310094100951009610097100981009910100101011010210103101041010510106101071010810109101101011110112101131011410115101161011710118101191012010121101221012310124101251012610127101281012910130101311013210133101341013510136101371013810139101401014110142101431014410145101461014710148101491015010151101521015310154101551015610157101581015910160101611016210163101641016510166101671016810169101701017110172101731017410175101761017710178101791018010181101821018310184101851018610187101881018910190101911019210193101941019510196101971019810199102001020110202102031020410205102061020710208102091021010211102121021310214102151021610217102181021910220102211022210223102241022510226102271022810229102301023110232102331023410235102361023710238102391024010241102421024310244102451024610247102481024910250102511025210253102541025510256102571025810259102601026110262102631026410265102661026710268102691027010271102721027310274102751027610277102781027910280102811028210283102841028510286102871028810289102901029110292102931029410295102961029710298102991030010301103021030310304103051030610307103081030910310103111031210313103141031510316103171031810319103201032110322103231032410325103261032710328103291033010331103321033310334103351033610337103381033910340103411034210343103441034510346103471034810349103501035110352103531035410355103561035710358103591036010361103621036310364103651036610367103681036910370103711037210373103741037510376103771037810379103801038110382103831038410385103861038710388103891039010391103921039310394103951039610397103981039910400104011040210403104041040510406104071040810409104101041110412104131041410415104161041710418104191042010421104221042310424104251042610427104281042910430104311043210433104341043510436104371043810439104401044110442104431044410445104461044710448104491045010451104521045310454104551045610457104581045910460104611046210463104641046510466104671046810469104701047110472104731047410475104761047710478104791048010481104821048310484104851048610487104881048910490104911049210493104941049510496104971049810499105001050110502105031050410505105061050710508105091051010511105121051310514105151051610517105181051910520105211052210523105241052510526105271052810529105301053110532105331053410535105361053710538105391054010541105421054310544105451054610547105481054910550105511055210553105541055510556105571055810559105601056110562105631056410565105661056710568105691057010571105721057310574105751057610577105781057910580105811058210583105841058510586105871058810589105901059110592105931059410595105961059710598105991060010601106021060310604106051060610607106081060910610106111061210613106141061510616106171061810619106201062110622106231062410625106261062710628106291063010631106321063310634106351063610637106381063910640106411064210643106441064510646106471064810649106501065110652106531065410655106561065710658106591066010661106621066310664106651066610667106681066910670106711067210673106741067510676106771067810679106801068110682106831068410685106861068710688106891069010691106921069310694106951069610697106981069910700107011070210703107041070510706107071070810709107101071110712107131071410715107161071710718107191072010721107221072310724107251072610727107281072910730107311073210733107341073510736107371073810739107401074110742107431074410745107461074710748107491075010751107521075310754107551075610757107581075910760107611076210763107641076510766107671076810769107701077110772107731077410775107761077710778107791078010781107821078310784107851078610787107881078910790107911079210793107941079510796107971079810799108001080110802108031080410805108061080710808108091081010811108121081310814108151081610817108181081910820108211082210823108241082510826108271082810829108301083110832108331083410835108361083710838108391084010841108421084310844108451084610847108481084910850108511085210853108541085510856108571085810859108601086110862108631086410865108661086710868108691087010871108721087310874108751087610877108781087910880108811088210883108841088510886108871088810889108901089110892108931089410895108961089710898108991090010901109021090310904109051090610907109081090910910109111091210913109141091510916109171091810919109201092110922109231092410925109261092710928109291093010931109321093310934109351093610937109381093910940109411094210943109441094510946109471094810949109501095110952109531095410955109561095710958109591096010961109621096310964109651096610967109681096910970109711097210973109741097510976109771097810979109801098110982109831098410985109861098710988109891099010991109921099310994109951099610997109981099911000110011100211003110041100511006110071100811009110101101111012110131101411015110161101711018110191102011021110221102311024110251102611027110281102911030110311103211033110341103511036110371103811039110401104111042110431104411045110461104711048110491105011051110521105311054110551105611057110581105911060110611106211063110641106511066110671106811069110701107111072110731107411075110761107711078110791108011081110821108311084110851108611087110881108911090110911109211093110941109511096110971109811099111001110111102111031110411105111061110711108111091111011111111121111311114111151111611117111181111911120111211112211123111241112511126111271112811129111301113111132111331113411135111361113711138111391114011141111421114311144111451114611147111481114911150111511115211153111541115511156111571115811159111601116111162111631116411165111661116711168111691117011171111721117311174111751117611177111781117911180111811118211183111841118511186111871118811189111901119111192111931119411195111961119711198111991120011201112021120311204112051120611207112081120911210112111121211213112141121511216112171121811219112201122111222112231122411225112261122711228112291123011231112321123311234112351123611237112381123911240112411124211243112441124511246112471124811249112501125111252112531125411255112561125711258112591126011261112621126311264112651126611267112681126911270112711127211273112741127511276112771127811279112801128111282112831128411285112861128711288112891129011291112921129311294112951129611297112981129911300113011130211303113041130511306113071130811309113101131111312113131131411315113161131711318113191132011321113221132311324113251132611327113281132911330113311133211333113341133511336113371133811339113401134111342113431134411345113461134711348113491135011351113521135311354113551135611357113581135911360113611136211363113641136511366113671136811369113701137111372113731137411375113761137711378113791138011381113821138311384113851138611387113881138911390113911139211393113941139511396113971139811399114001140111402114031140411405114061140711408114091141011411114121141311414114151141611417114181141911420114211142211423114241142511426114271142811429114301143111432114331143411435114361143711438114391144011441114421144311444114451144611447114481144911450114511145211453114541145511456114571145811459114601146111462114631146411465114661146711468114691147011471114721147311474114751147611477114781147911480114811148211483114841148511486114871148811489114901149111492114931149411495114961149711498114991150011501115021150311504115051150611507115081150911510115111151211513115141151511516115171151811519115201152111522115231152411525115261152711528115291153011531115321153311534115351153611537115381153911540115411154211543115441154511546115471154811549115501155111552115531155411555115561155711558115591156011561115621156311564115651156611567115681156911570115711157211573115741157511576115771157811579115801158111582115831158411585115861158711588115891159011591115921159311594115951159611597115981159911600116011160211603116041160511606116071160811609116101161111612116131161411615116161161711618116191162011621116221162311624116251162611627116281162911630116311163211633116341163511636116371163811639116401164111642116431164411645116461164711648116491165011651116521165311654116551165611657116581165911660116611166211663116641166511666116671166811669116701167111672116731167411675116761167711678116791168011681116821168311684116851168611687116881168911690116911169211693116941169511696116971169811699117001170111702117031170411705117061170711708117091171011711117121171311714117151171611717117181171911720117211172211723117241172511726117271172811729117301173111732117331173411735117361173711738117391174011741117421174311744117451174611747117481174911750117511175211753117541175511756117571175811759117601176111762117631176411765117661176711768117691177011771117721177311774117751177611777117781177911780117811178211783117841178511786117871178811789117901179111792117931179411795117961179711798117991180011801118021180311804118051180611807118081180911810118111181211813118141181511816118171181811819118201182111822118231182411825118261182711828118291183011831118321183311834118351183611837118381183911840118411184211843118441184511846118471184811849118501185111852118531185411855118561185711858118591186011861118621186311864118651186611867118681186911870118711187211873118741187511876118771187811879118801188111882118831188411885118861188711888118891189011891118921189311894118951189611897118981189911900119011190211903119041190511906119071190811909119101191111912119131191411915119161191711918119191192011921119221192311924119251192611927119281192911930119311193211933119341193511936119371193811939119401194111942119431194411945119461194711948119491195011951119521195311954119551195611957119581195911960119611196211963119641196511966119671196811969119701197111972119731197411975119761197711978119791198011981119821198311984119851198611987119881198911990119911199211993119941199511996119971199811999120001200112002120031200412005120061200712008120091201012011120121201312014120151201612017120181201912020120211202212023120241202512026120271202812029120301203112032120331203412035120361203712038120391204012041120421204312044120451204612047120481204912050120511205212053120541205512056120571205812059120601206112062120631206412065120661206712068120691207012071120721207312074120751207612077120781207912080120811208212083120841208512086120871208812089120901209112092120931209412095120961209712098120991210012101121021210312104121051210612107121081210912110121111211212113121141211512116121171211812119121201212112122121231212412125121261212712128121291213012131121321213312134121351213612137121381213912140121411214212143121441214512146121471214812149121501215112152121531215412155121561215712158121591216012161121621216312164121651216612167121681216912170121711217212173121741217512176121771217812179121801218112182121831218412185121861218712188121891219012191121921219312194121951219612197121981219912200122011220212203122041220512206122071220812209122101221112212122131221412215122161221712218122191222012221122221222312224122251222612227122281222912230122311223212233122341223512236122371223812239122401224112242122431224412245122461224712248122491225012251122521225312254122551225612257122581225912260122611226212263122641226512266122671226812269122701227112272122731227412275122761227712278122791228012281122821228312284122851228612287122881228912290122911229212293122941229512296122971229812299123001230112302123031230412305123061230712308123091231012311123121231312314123151231612317123181231912320123211232212323123241232512326123271232812329123301233112332123331233412335123361233712338123391234012341123421234312344123451234612347123481234912350123511235212353123541235512356123571235812359123601236112362123631236412365123661236712368123691237012371123721237312374123751237612377123781237912380123811238212383123841238512386123871238812389123901239112392123931239412395123961239712398123991240012401124021240312404124051240612407124081240912410124111241212413124141241512416124171241812419124201242112422124231242412425124261242712428124291243012431124321243312434124351243612437124381243912440124411244212443124441244512446124471244812449124501245112452124531245412455124561245712458124591246012461124621246312464124651246612467124681246912470124711247212473124741247512476124771247812479124801248112482124831248412485124861248712488124891249012491124921249312494124951249612497124981249912500125011250212503125041250512506125071250812509125101251112512125131251412515125161251712518125191252012521125221252312524125251252612527125281252912530125311253212533125341253512536125371253812539125401254112542125431254412545125461254712548125491255012551125521255312554125551255612557125581255912560125611256212563125641256512566125671256812569125701257112572125731257412575125761257712578125791258012581125821258312584125851258612587125881258912590125911259212593125941259512596125971259812599126001260112602126031260412605126061260712608126091261012611126121261312614126151261612617126181261912620126211262212623126241262512626126271262812629126301263112632126331263412635126361263712638126391264012641126421264312644126451264612647126481264912650126511265212653126541265512656126571265812659126601266112662126631266412665126661266712668126691267012671126721267312674126751267612677126781267912680126811268212683126841268512686126871268812689126901269112692126931269412695126961269712698126991270012701127021270312704127051270612707127081270912710127111271212713127141271512716127171271812719127201272112722127231272412725127261272712728127291273012731127321273312734127351273612737127381273912740127411274212743127441274512746127471274812749127501275112752127531275412755127561275712758127591276012761127621276312764127651276612767127681276912770127711277212773127741277512776127771277812779127801278112782127831278412785127861278712788127891279012791127921279312794127951279612797127981279912800128011280212803128041280512806128071280812809128101281112812128131281412815128161281712818128191282012821128221282312824128251282612827128281282912830128311283212833128341283512836128371283812839128401284112842128431284412845128461284712848128491285012851128521285312854128551285612857128581285912860128611286212863128641286512866128671286812869128701287112872128731287412875128761287712878128791288012881128821288312884128851288612887128881288912890128911289212893128941289512896128971289812899129001290112902129031290412905129061290712908129091291012911129121291312914129151291612917129181291912920129211292212923129241292512926129271292812929129301293112932129331293412935129361293712938129391294012941129421294312944129451294612947129481294912950129511295212953129541295512956129571295812959129601296112962129631296412965129661296712968129691297012971129721297312974129751297612977129781297912980129811298212983129841298512986129871298812989129901299112992129931299412995129961299712998129991300013001130021300313004130051300613007130081300913010130111301213013130141301513016130171301813019130201302113022130231302413025130261302713028130291303013031130321303313034130351303613037130381303913040130411304213043130441304513046130471304813049130501305113052130531305413055130561305713058130591306013061130621306313064130651306613067130681306913070130711307213073130741307513076130771307813079130801308113082130831308413085130861308713088130891309013091130921309313094130951309613097130981309913100131011310213103131041310513106131071310813109131101311113112131131311413115131161311713118131191312013121131221312313124131251312613127131281312913130131311313213133131341313513136131371313813139131401314113142131431314413145131461314713148131491315013151131521315313154131551315613157131581315913160131611316213163131641316513166131671316813169131701317113172131731317413175131761317713178131791318013181131821318313184131851318613187131881318913190131911319213193131941319513196131971319813199132001320113202132031320413205132061320713208132091321013211132121321313214132151321613217132181321913220132211322213223132241322513226132271322813229132301323113232132331323413235132361323713238132391324013241132421324313244132451324613247132481324913250132511325213253132541325513256132571325813259132601326113262132631326413265132661326713268132691327013271132721327313274132751327613277132781327913280132811328213283132841328513286132871328813289132901329113292132931329413295132961329713298132991330013301133021330313304133051330613307133081330913310133111331213313133141331513316133171331813319133201332113322133231332413325133261332713328133291333013331133321333313334133351333613337133381333913340133411334213343133441334513346133471334813349133501335113352133531335413355133561335713358133591336013361133621336313364133651336613367133681336913370133711337213373133741337513376133771337813379133801338113382133831338413385133861338713388133891339013391133921339313394133951339613397133981339913400134011340213403134041340513406134071340813409134101341113412134131341413415134161341713418134191342013421134221342313424134251342613427134281342913430134311343213433134341343513436134371343813439134401344113442134431344413445134461344713448134491345013451134521345313454134551345613457134581345913460134611346213463134641346513466134671346813469134701347113472134731347413475134761347713478134791348013481134821348313484134851348613487134881348913490134911349213493134941349513496134971349813499135001350113502135031350413505135061350713508135091351013511135121351313514135151351613517135181351913520135211352213523135241352513526135271352813529135301353113532135331353413535135361353713538135391354013541135421354313544135451354613547135481354913550135511355213553135541355513556135571355813559135601356113562135631356413565135661356713568135691357013571135721357313574135751357613577135781357913580135811358213583135841358513586135871358813589135901359113592135931359413595135961359713598135991360013601136021360313604136051360613607136081360913610136111361213613136141361513616136171361813619136201362113622136231362413625136261362713628136291363013631136321363313634136351363613637136381363913640136411364213643136441364513646136471364813649136501365113652136531365413655136561365713658136591366013661136621366313664136651366613667136681366913670136711367213673136741367513676136771367813679136801368113682136831368413685136861368713688136891369013691136921369313694136951369613697136981369913700137011370213703137041370513706137071370813709137101371113712137131371413715137161371713718137191372013721137221372313724137251372613727137281372913730137311373213733137341373513736137371373813739137401374113742137431374413745137461374713748137491375013751137521375313754137551375613757137581375913760137611376213763137641376513766137671376813769137701377113772137731377413775137761377713778137791378013781137821378313784137851378613787137881378913790137911379213793137941379513796137971379813799138001380113802138031380413805138061380713808138091381013811138121381313814138151381613817138181381913820138211382213823138241382513826138271382813829138301383113832138331383413835138361383713838138391384013841138421384313844138451384613847138481384913850138511385213853138541385513856138571385813859138601386113862138631386413865138661386713868138691387013871138721387313874138751387613877138781387913880138811388213883138841388513886138871388813889138901389113892138931389413895138961389713898138991390013901139021390313904139051390613907139081390913910139111391213913139141391513916139171391813919139201392113922139231392413925139261392713928139291393013931139321393313934139351393613937139381393913940139411394213943139441394513946139471394813949139501395113952139531395413955139561395713958139591396013961139621396313964139651396613967139681396913970139711397213973139741397513976139771397813979139801398113982139831398413985139861398713988139891399013991139921399313994139951399613997139981399914000140011400214003140041400514006140071400814009140101401114012140131401414015140161401714018140191402014021140221402314024140251402614027140281402914030140311403214033140341403514036140371403814039140401404114042140431404414045140461404714048140491405014051140521405314054140551405614057140581405914060140611406214063140641406514066140671406814069140701407114072140731407414075140761407714078140791408014081140821408314084140851408614087140881408914090140911409214093140941409514096140971409814099141001410114102141031410414105141061410714108141091411014111141121411314114141151411614117141181411914120141211412214123141241412514126141271412814129141301413114132141331413414135141361413714138141391414014141141421414314144141451414614147141481414914150141511415214153141541415514156141571415814159141601416114162141631416414165141661416714168141691417014171141721417314174141751417614177141781417914180141811418214183141841418514186141871418814189141901419114192141931419414195141961419714198141991420014201142021420314204142051420614207142081420914210142111421214213142141421514216142171421814219142201422114222142231422414225142261422714228142291423014231142321423314234142351423614237142381423914240142411424214243142441424514246142471424814249142501425114252142531425414255142561425714258142591426014261142621426314264142651426614267142681426914270142711427214273142741427514276142771427814279142801428114282142831428414285142861428714288142891429014291142921429314294142951429614297142981429914300143011430214303143041430514306143071430814309143101431114312143131431414315143161431714318143191432014321143221432314324143251432614327143281432914330143311433214333143341433514336143371433814339143401434114342143431434414345143461434714348143491435014351143521435314354143551435614357143581435914360143611436214363143641436514366143671436814369143701437114372143731437414375143761437714378143791438014381143821438314384143851438614387143881438914390143911439214393143941439514396143971439814399144001440114402144031440414405144061440714408144091441014411144121441314414144151441614417144181441914420144211442214423144241442514426144271442814429144301443114432144331443414435144361443714438144391444014441144421444314444144451444614447144481444914450144511445214453144541445514456144571445814459144601446114462144631446414465144661446714468144691447014471144721447314474144751447614477144781447914480144811448214483144841448514486144871448814489144901449114492144931449414495144961449714498144991450014501145021450314504145051450614507145081450914510145111451214513145141451514516145171451814519145201452114522145231452414525145261452714528145291453014531145321453314534145351453614537145381453914540145411454214543145441454514546145471454814549145501455114552145531455414555145561455714558145591456014561145621456314564145651456614567145681456914570145711457214573145741457514576145771457814579145801458114582145831458414585145861458714588145891459014591145921459314594145951459614597145981459914600146011460214603146041460514606146071460814609146101461114612146131461414615146161461714618146191462014621146221462314624146251462614627146281462914630146311463214633146341463514636146371463814639146401464114642146431464414645146461464714648146491465014651146521465314654146551465614657146581465914660146611466214663146641466514666146671466814669146701467114672146731467414675146761467714678146791468014681146821468314684146851468614687146881468914690146911469214693146941469514696146971469814699147001470114702147031470414705147061470714708147091471014711147121471314714147151471614717147181471914720147211472214723147241472514726147271472814729147301473114732147331473414735147361473714738147391474014741147421474314744147451474614747147481474914750147511475214753147541475514756147571475814759147601476114762147631476414765147661476714768147691477014771147721477314774147751477614777147781477914780147811478214783147841478514786147871478814789147901479114792147931479414795147961479714798147991480014801148021480314804148051480614807148081480914810148111481214813148141481514816148171481814819148201482114822148231482414825148261482714828148291483014831148321483314834148351483614837148381483914840148411484214843148441484514846148471484814849148501485114852148531485414855148561485714858148591486014861148621486314864148651486614867148681486914870148711487214873148741487514876148771487814879148801488114882148831488414885148861488714888148891489014891148921489314894148951489614897148981489914900149011490214903149041490514906149071490814909149101491114912149131491414915149161491714918149191492014921149221492314924149251492614927149281492914930149311493214933149341493514936149371493814939149401494114942149431494414945149461494714948149491495014951149521495314954149551495614957149581495914960149611496214963149641496514966149671496814969149701497114972149731497414975149761497714978149791498014981149821498314984149851498614987149881498914990149911499214993149941499514996149971499814999150001500115002150031500415005150061500715008150091501015011150121501315014150151501615017150181501915020150211502215023150241502515026150271502815029150301503115032150331503415035150361503715038150391504015041150421504315044150451504615047150481504915050150511505215053150541505515056150571505815059150601506115062150631506415065150661506715068150691507015071150721507315074150751507615077150781507915080150811508215083150841508515086150871508815089150901509115092150931509415095150961509715098150991510015101151021510315104151051510615107151081510915110151111511215113151141511515116151171511815119151201512115122151231512415125151261512715128151291513015131151321513315134151351513615137151381513915140151411514215143151441514515146151471514815149151501515115152151531515415155151561515715158151591516015161151621516315164151651516615167151681516915170151711517215173151741517515176151771517815179151801518115182151831518415185151861518715188151891519015191151921519315194151951519615197151981519915200152011520215203152041520515206152071520815209152101521115212152131521415215152161521715218152191522015221152221522315224152251522615227152281522915230152311523215233152341523515236152371523815239152401524115242152431524415245152461524715248152491525015251152521525315254152551525615257152581525915260152611526215263152641526515266152671526815269152701527115272152731527415275152761527715278152791528015281152821528315284152851528615287152881528915290152911529215293152941529515296152971529815299153001530115302153031530415305153061530715308153091531015311153121531315314153151531615317153181531915320153211532215323153241532515326153271532815329153301533115332153331533415335153361533715338153391534015341153421534315344153451534615347153481534915350153511535215353153541535515356153571535815359153601536115362153631536415365153661536715368153691537015371153721537315374153751537615377153781537915380153811538215383153841538515386153871538815389153901539115392153931539415395153961539715398153991540015401154021540315404154051540615407154081540915410154111541215413154141541515416154171541815419154201542115422154231542415425154261542715428154291543015431154321543315434154351543615437154381543915440154411544215443154441544515446154471544815449154501545115452154531545415455154561545715458154591546015461154621546315464154651546615467154681546915470154711547215473154741547515476154771547815479154801548115482154831548415485154861548715488154891549015491154921549315494154951549615497154981549915500155011550215503155041550515506155071550815509155101551115512155131551415515155161551715518155191552015521155221552315524155251552615527155281552915530155311553215533155341553515536155371553815539155401554115542155431554415545155461554715548155491555015551155521555315554155551555615557155581555915560155611556215563155641556515566155671556815569155701557115572155731557415575155761557715578155791558015581155821558315584155851558615587155881558915590155911559215593155941559515596155971559815599156001560115602156031560415605156061560715608156091561015611156121561315614156151561615617156181561915620156211562215623156241562515626156271562815629156301563115632156331563415635156361563715638156391564015641156421564315644156451564615647156481564915650156511565215653156541565515656156571565815659156601566115662156631566415665156661566715668156691567015671156721567315674156751567615677156781567915680156811568215683156841568515686156871568815689156901569115692156931569415695156961569715698156991570015701157021570315704157051570615707157081570915710157111571215713157141571515716157171571815719157201572115722157231572415725157261572715728157291573015731157321573315734157351573615737157381573915740157411574215743157441574515746157471574815749157501575115752157531575415755157561575715758157591576015761157621576315764157651576615767157681576915770157711577215773157741577515776157771577815779157801578115782157831578415785157861578715788157891579015791157921579315794157951579615797157981579915800158011580215803158041580515806158071580815809158101581115812158131581415815158161581715818158191582015821158221582315824158251582615827158281582915830158311583215833158341583515836158371583815839158401584115842158431584415845158461584715848158491585015851158521585315854158551585615857158581585915860158611586215863158641586515866158671586815869158701587115872158731587415875158761587715878158791588015881158821588315884158851588615887158881588915890158911589215893158941589515896158971589815899159001590115902159031590415905159061590715908159091591015911159121591315914159151591615917159181591915920159211592215923159241592515926159271592815929159301593115932159331593415935159361593715938159391594015941159421594315944159451594615947159481594915950159511595215953159541595515956159571595815959159601596115962159631596415965159661596715968159691597015971159721597315974159751597615977159781597915980159811598215983159841598515986159871598815989159901599115992159931599415995159961599715998159991600016001160021600316004160051600616007160081600916010160111601216013160141601516016160171601816019160201602116022160231602416025160261602716028160291603016031160321603316034160351603616037160381603916040160411604216043160441604516046160471604816049160501605116052160531605416055160561605716058160591606016061160621606316064160651606616067160681606916070160711607216073160741607516076160771607816079160801608116082160831608416085160861608716088160891609016091160921609316094160951609616097160981609916100161011610216103161041610516106161071610816109161101611116112161131611416115161161611716118161191612016121161221612316124161251612616127161281612916130161311613216133161341613516136161371613816139161401614116142161431614416145161461614716148161491615016151161521615316154161551615616157161581615916160161611616216163161641616516166161671616816169161701617116172161731617416175161761617716178161791618016181161821618316184161851618616187161881618916190161911619216193161941619516196161971619816199162001620116202162031620416205162061620716208162091621016211162121621316214162151621616217162181621916220162211622216223162241622516226162271622816229162301623116232162331623416235162361623716238162391624016241162421624316244162451624616247162481624916250162511625216253162541625516256162571625816259162601626116262162631626416265162661626716268162691627016271162721627316274162751627616277162781627916280162811628216283162841628516286162871628816289162901629116292162931629416295162961629716298162991630016301163021630316304163051630616307163081630916310163111631216313163141631516316163171631816319163201632116322163231632416325163261632716328163291633016331163321633316334163351633616337163381633916340163411634216343163441634516346163471634816349163501635116352163531635416355163561635716358163591636016361163621636316364163651636616367163681636916370163711637216373163741637516376163771637816379163801638116382163831638416385163861638716388163891639016391163921639316394163951639616397163981639916400164011640216403164041640516406164071640816409164101641116412164131641416415164161641716418164191642016421164221642316424164251642616427164281642916430164311643216433164341643516436164371643816439164401644116442164431644416445164461644716448164491645016451164521645316454164551645616457164581645916460164611646216463164641646516466164671646816469164701647116472164731647416475164761647716478164791648016481164821648316484164851648616487164881648916490164911649216493164941649516496164971649816499165001650116502165031650416505165061650716508165091651016511165121651316514165151651616517165181651916520165211652216523165241652516526165271652816529165301653116532165331653416535165361653716538165391654016541165421654316544165451654616547165481654916550165511655216553165541655516556165571655816559165601656116562165631656416565165661656716568165691657016571165721657316574165751657616577165781657916580165811658216583165841658516586165871658816589165901659116592165931659416595165961659716598165991660016601166021660316604166051660616607166081660916610166111661216613166141661516616166171661816619166201662116622166231662416625166261662716628166291663016631166321663316634166351663616637166381663916640166411664216643166441664516646166471664816649166501665116652166531665416655166561665716658166591666016661166621666316664166651666616667166681666916670166711667216673166741667516676166771667816679166801668116682166831668416685166861668716688166891669016691166921669316694166951669616697166981669916700167011670216703167041670516706167071670816709167101671116712167131671416715167161671716718167191672016721167221672316724167251672616727167281672916730167311673216733167341673516736167371673816739167401674116742167431674416745167461674716748167491675016751167521675316754167551675616757167581675916760167611676216763167641676516766167671676816769167701677116772167731677416775167761677716778167791678016781167821678316784167851678616787167881678916790167911679216793167941679516796167971679816799168001680116802168031680416805168061680716808168091681016811168121681316814168151681616817168181681916820168211682216823168241682516826168271682816829168301683116832168331683416835168361683716838168391684016841168421684316844168451684616847168481684916850168511685216853168541685516856168571685816859168601686116862168631686416865168661686716868168691687016871168721687316874168751687616877168781687916880168811688216883168841688516886168871688816889168901689116892168931689416895168961689716898168991690016901169021690316904169051690616907169081690916910169111691216913169141691516916169171691816919169201692116922169231692416925169261692716928169291693016931169321693316934169351693616937169381693916940169411694216943169441694516946169471694816949169501695116952169531695416955169561695716958169591696016961169621696316964169651696616967169681696916970169711697216973169741697516976169771697816979169801698116982169831698416985169861698716988169891699016991169921699316994169951699616997169981699917000170011700217003170041700517006170071700817009170101701117012170131701417015170161701717018170191702017021170221702317024170251702617027170281702917030170311703217033170341703517036170371703817039170401704117042170431704417045170461704717048170491705017051170521705317054170551705617057170581705917060170611706217063170641706517066170671706817069170701707117072170731707417075170761707717078170791708017081170821708317084170851708617087170881708917090170911709217093170941709517096170971709817099171001710117102171031710417105171061710717108171091711017111171121711317114171151711617117171181711917120171211712217123171241712517126171271712817129171301713117132171331713417135171361713717138171391714017141171421714317144171451714617147171481714917150171511715217153171541715517156171571715817159171601716117162171631716417165171661716717168171691717017171171721717317174171751717617177171781717917180171811718217183171841718517186171871718817189171901719117192171931719417195171961719717198171991720017201172021720317204172051720617207172081720917210172111721217213172141721517216172171721817219172201722117222172231722417225172261722717228172291723017231172321723317234172351723617237172381723917240172411724217243172441724517246172471724817249172501725117252172531725417255172561725717258172591726017261172621726317264172651726617267172681726917270172711727217273172741727517276172771727817279172801728117282172831728417285172861728717288172891729017291172921729317294172951729617297172981729917300173011730217303173041730517306173071730817309173101731117312173131731417315173161731717318173191732017321173221732317324173251732617327173281732917330173311733217333173341733517336173371733817339173401734117342173431734417345173461734717348173491735017351173521735317354173551735617357173581735917360173611736217363173641736517366173671736817369173701737117372173731737417375173761737717378173791738017381173821738317384173851738617387173881738917390173911739217393173941739517396173971739817399174001740117402174031740417405174061740717408174091741017411174121741317414174151741617417174181741917420174211742217423174241742517426174271742817429174301743117432174331743417435174361743717438174391744017441174421744317444174451744617447174481744917450174511745217453174541745517456174571745817459174601746117462174631746417465174661746717468174691747017471174721747317474174751747617477174781747917480174811748217483174841748517486174871748817489174901749117492174931749417495174961749717498174991750017501175021750317504175051750617507175081750917510175111751217513175141751517516175171751817519175201752117522175231752417525175261752717528175291753017531175321753317534175351753617537175381753917540175411754217543175441754517546175471754817549175501755117552175531755417555175561755717558175591756017561175621756317564175651756617567175681756917570175711757217573175741757517576175771757817579175801758117582175831758417585175861758717588175891759017591175921759317594175951759617597175981759917600176011760217603176041760517606176071760817609176101761117612176131761417615176161761717618176191762017621176221762317624176251762617627176281762917630176311763217633176341763517636176371763817639176401764117642176431764417645176461764717648176491765017651176521765317654176551765617657176581765917660176611766217663176641766517666176671766817669176701767117672176731767417675176761767717678176791768017681176821768317684176851768617687176881768917690176911769217693176941769517696176971769817699177001770117702177031770417705177061770717708177091771017711177121771317714177151771617717177181771917720177211772217723177241772517726177271772817729177301773117732177331773417735177361773717738177391774017741177421774317744177451774617747177481774917750177511775217753177541775517756177571775817759177601776117762177631776417765177661776717768177691777017771177721777317774177751777617777177781777917780177811778217783177841778517786177871778817789177901779117792177931779417795177961779717798177991780017801178021780317804178051780617807178081780917810178111781217813178141781517816178171781817819178201782117822178231782417825178261782717828178291783017831178321783317834178351783617837178381783917840178411784217843178441784517846178471784817849178501785117852178531785417855178561785717858178591786017861178621786317864178651786617867178681786917870178711787217873178741787517876178771787817879178801788117882178831788417885178861788717888178891789017891178921789317894178951789617897178981789917900179011790217903179041790517906179071790817909179101791117912179131791417915179161791717918179191792017921179221792317924179251792617927179281792917930179311793217933179341793517936179371793817939179401794117942179431794417945179461794717948179491795017951179521795317954179551795617957179581795917960179611796217963179641796517966179671796817969179701797117972179731797417975179761797717978179791798017981179821798317984179851798617987179881798917990179911799217993179941799517996179971799817999180001800118002180031800418005180061800718008180091801018011180121801318014180151801618017180181801918020180211802218023180241802518026180271802818029180301803118032180331803418035180361803718038180391804018041180421804318044180451804618047180481804918050180511805218053180541805518056180571805818059180601806118062180631806418065180661806718068180691807018071180721807318074180751807618077180781807918080180811808218083180841808518086180871808818089180901809118092180931809418095180961809718098180991810018101181021810318104181051810618107181081810918110181111811218113181141811518116181171811818119181201812118122181231812418125181261812718128181291813018131181321813318134181351813618137181381813918140181411814218143181441814518146181471814818149181501815118152181531815418155181561815718158181591816018161181621816318164181651816618167181681816918170181711817218173181741817518176181771817818179181801818118182181831818418185181861818718188181891819018191181921819318194181951819618197181981819918200182011820218203182041820518206182071820818209182101821118212182131821418215182161821718218182191822018221182221822318224182251822618227182281822918230182311823218233182341823518236182371823818239182401824118242182431824418245182461824718248182491825018251182521825318254182551825618257182581825918260182611826218263182641826518266182671826818269182701827118272182731827418275182761827718278182791828018281182821828318284182851828618287182881828918290182911829218293182941829518296182971829818299183001830118302183031830418305183061830718308183091831018311183121831318314183151831618317183181831918320183211832218323183241832518326183271832818329183301833118332183331833418335183361833718338183391834018341183421834318344183451834618347183481834918350183511835218353183541835518356183571835818359183601836118362183631836418365183661836718368183691837018371183721837318374183751837618377183781837918380183811838218383183841838518386183871838818389183901839118392183931839418395183961839718398183991840018401184021840318404184051840618407184081840918410184111841218413184141841518416184171841818419184201842118422184231842418425184261842718428184291843018431184321843318434184351843618437184381843918440184411844218443184441844518446184471844818449184501845118452184531845418455184561845718458184591846018461184621846318464184651846618467184681846918470184711847218473184741847518476184771847818479184801848118482184831848418485184861848718488184891849018491184921849318494184951849618497184981849918500185011850218503185041850518506185071850818509185101851118512185131851418515185161851718518185191852018521185221852318524185251852618527185281852918530185311853218533185341853518536185371853818539185401854118542185431854418545185461854718548185491855018551185521855318554185551855618557185581855918560185611856218563185641856518566185671856818569185701857118572185731857418575185761857718578185791858018581185821858318584185851858618587185881858918590185911859218593185941859518596185971859818599186001860118602186031860418605186061860718608186091861018611186121861318614186151861618617186181861918620186211862218623186241862518626186271862818629186301863118632186331863418635186361863718638186391864018641186421864318644186451864618647186481864918650186511865218653186541865518656186571865818659186601866118662186631866418665186661866718668186691867018671186721867318674186751867618677186781867918680186811868218683186841868518686186871868818689186901869118692186931869418695186961869718698186991870018701187021870318704187051870618707187081870918710187111871218713187141871518716187171871818719187201872118722187231872418725187261872718728187291873018731187321873318734187351873618737187381873918740187411874218743187441874518746187471874818749187501875118752187531875418755187561875718758187591876018761187621876318764187651876618767187681876918770187711877218773187741877518776187771877818779187801878118782187831878418785187861878718788187891879018791187921879318794187951879618797187981879918800188011880218803188041880518806188071880818809188101881118812188131881418815188161881718818188191882018821188221882318824188251882618827188281882918830188311883218833188341883518836188371883818839188401884118842188431884418845188461884718848188491885018851188521885318854188551885618857188581885918860188611886218863188641886518866188671886818869188701887118872188731887418875188761887718878188791888018881188821888318884188851888618887188881888918890188911889218893188941889518896188971889818899189001890118902189031890418905189061890718908189091891018911189121891318914189151891618917189181891918920189211892218923189241892518926189271892818929189301893118932189331893418935189361893718938189391894018941189421894318944189451894618947189481894918950189511895218953189541895518956189571895818959189601896118962189631896418965189661896718968189691897018971189721897318974189751897618977189781897918980189811898218983189841898518986189871898818989189901899118992189931899418995189961899718998189991900019001190021900319004190051900619007190081900919010190111901219013190141901519016190171901819019190201902119022190231902419025190261902719028190291903019031190321903319034190351903619037190381903919040190411904219043190441904519046190471904819049190501905119052190531905419055190561905719058190591906019061190621906319064190651906619067190681906919070190711907219073190741907519076190771907819079190801908119082190831908419085190861908719088190891909019091190921909319094190951909619097190981909919100191011910219103191041910519106191071910819109191101911119112191131911419115191161911719118191191912019121191221912319124191251912619127191281912919130191311913219133191341913519136191371913819139191401914119142191431914419145191461914719148191491915019151191521915319154191551915619157191581915919160191611916219163191641916519166191671916819169191701917119172191731917419175191761917719178191791918019181191821918319184191851918619187191881918919190191911919219193191941919519196191971919819199192001920119202192031920419205192061920719208192091921019211192121921319214192151921619217192181921919220192211922219223192241922519226192271922819229192301923119232192331923419235192361923719238192391924019241192421924319244192451924619247192481924919250192511925219253192541925519256192571925819259192601926119262192631926419265192661926719268192691927019271192721927319274192751927619277192781927919280192811928219283192841928519286192871928819289192901929119292192931929419295192961929719298192991930019301193021930319304193051930619307193081930919310193111931219313193141931519316193171931819319193201932119322193231932419325193261932719328193291933019331193321933319334193351933619337193381933919340193411934219343193441934519346193471934819349193501935119352193531935419355193561935719358193591936019361 |
- /*
- ****************************************************************************
- * Copyright (C) 2014 Bosch Sensortec GmbH
- *
- * bmi160.c
- * Date: 2014/12/12
- * Revision: 2.0.5 $
- *
- * Usage: Sensor Driver for BMI160 sensor
- *
- ****************************************************************************
- * License:
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions are met:
- *
- * Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- *
- * Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- *
- * Neither the name of the copyright holder nor the names of the
- * contributors may be used to endorse or promote products derived from
- * this software without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
- * CONTRIBUTORS "AS IS" AND ANY EXPRESS OR
- * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
- * DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDER
- * OR CONTRIBUTORS BE LIABLE FOR ANY
- * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
- * OR CONSEQUENTIAL DAMAGES(INCLUDING, BUT NOT LIMITED TO,
- * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
- * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
- * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
- * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
- * ANY WAY OUT OF THE USE OF THIS
- * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE
- *
- * The information provided is believed to be accurate and reliable.
- * The copyright holder assumes no responsibility
- * for the consequences of use
- * of such information nor for any infringement of patents or
- * other rights of third parties which may result from its use.
- * No license is granted by implication or otherwise under any patent or
- * patent rights of the copyright holder.
- **************************************************************************/
- /*! file <BMI160 >
- brief <Sensor driver for BMI160> */
- #include "bmi160.h"
- #include "SEGGER_RTT.h"
- /* user defined code to be added here ... */
- static struct bmi160_t *p_bmi160;
- /* used for reading the mag trim values for compensation*/
- static struct trim_data_t mag_trim;
- /* the following variable used for avoiding the selecting of auto mode
- when it is running in the manual mode of BMM150 mag interface*/
- u8 V_bmm150_maual_auto_condition_u8 = C_BMI160_ZERO_U8X;
- /* used for reading the AKM compensating data */
- static struct bst_akm_sensitivity_data_t akm_asa_data;
- /* Assign the fifo time */
- u32 V_fifo_time_U32 = C_BMI160_ZERO_U8X;
- /* Used to store as accel fifo data */
- struct bmi160_accel_t accel_fifo[FIFO_FRAME_CNT];
- /* Used to store as gyro fifo data */
- struct bmi160_gyro_t gyro_fifo[FIFO_FRAME_CNT];
- /* Used to store as mag fifo data */
- struct bmi160_mag_t mag_fifo[FIFO_FRAME_CNT];
- /* FIFO data read for 1024 bytes of data */
- u8 v_fifo_data_u8[FIFO_FRAME] = {C_BMI160_ZERO_U8X};
- /* YAMAHA-YAS532*/
- /* value of coeff*/
- static const int yas532_version_ac_coef[] = {YAS532_VERSION_AC_COEF_X,
- YAS532_VERSION_AC_COEF_Y1, YAS532_VERSION_AC_COEF_Y2};
- /* used for reading the yas532 calibration data*/
- static struct yas532_t yas532_data;
- /*!
- * @brief
- * This function is used for initialize
- * bus read and bus write functions
- * assign the chip id and device address
- * chip id is read in the register 0x00 bit from 0 to 7
- *
- * @param bmi160 : structure pointer
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- * @note
- * While changing the parameter of the bmi160_t
- * consider the following point:
- * Changing the reference value of the parameter
- * will changes the local copy or local reference
- * make sure your changes will not
- * affect the reference value of the parameter
- * (Better case don't change the reference value of the parameter)
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_init(struct bmi160_t *bmi160)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- u8 v_pmu_data_u8 = BMI160_HEX_0_0_DATA;
- /* assign bmi160 ptr */
- p_bmi160 = bmi160;
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_CHIP_ID__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- /* read Chip Id */
- p_bmi160->chip_id = v_data_u8;
- /* To avoid gyro wakeup it is required to write 0x00 to 0x6C*/
- com_rslt += bmi160_write_reg(BMI160_USER_PMU_TRIGGER_ADDR,
- &v_pmu_data_u8, C_BMI160_ONE_U8X);
- return com_rslt;
- }
- /*!
- * @brief
- * This API write the data to
- * the given register
- *
- *
- * @param v_addr_u8 -> Address of the register
- * @param v_data_u8 -> The data from the register
- * @param v_len_u8 -> no of bytes to read
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_write_reg(u8 v_addr_u8,
- u8 *v_data_u8, u8 v_len_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write data from register*/
- com_rslt =
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->dev_addr,
- v_addr_u8, v_data_u8, v_len_u8);
- }
- return com_rslt;
- }
- /*!
- * @brief
- * This API reads the data from
- * the given register
- *
- *
- * @param v_addr_u8 -> Address of the register
- * @param v_data_u8 -> The data from the register
- * @param v_len_u8 -> no of bytes to read
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_reg(u8 v_addr_u8,
- u8 *v_data_u8, u8 v_len_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* Read data from register*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- v_addr_u8, v_data_u8, v_len_u8);
- }
- return com_rslt;
- }
- /*!
- * @brief This API used to reads the fatal error
- * from the Register 0x02 bit 0
- * This flag will be reset only by power-on-reset and soft reset
- *
- *
- * @param v_fatal_err_u8 : The status of fatal error
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_fatal_err(u8
- *v_fatal_err_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* reading the fatal error status*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FATAL_ERR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_fatal_err_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FATAL_ERR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API used to read the error code
- * from register 0x02 bit 1 to 4
- *
- *
- * @param v_err_code_u8 : The status of error codes
- * error_code | description
- * ------------|---------------
- * 0x00 |no error
- * 0x01 |ACC_CONF error (accel ODR and bandwidth not compatible)
- * 0x02 |GYR_CONF error (Gyroscope ODR and bandwidth not compatible)
- * 0x03 |Under sampling mode and interrupt uses pre filtered data
- * 0x04 |reserved
- * 0x05 |Selected trigger-readout offset in
- * - |MAG_IF greater than selected ODR
- * 0x06 |FIFO configuration error for header less mode
- * 0x07 |Under sampling mode and pre filtered data as FIFO source
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_err_code(u8
- *v_err_code_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_ERR_CODE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_err_code_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_ERR_CODE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API Reads the i2c error code from the
- * Register 0x02 bit 5.
- * This error occurred in I2C master detected
- *
- * @param v_i2c_err_code_u8 : The status of i2c fail error
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_i2c_fail_err(u8
- *v_i2c_err_code_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_I2C_FAIL_ERR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_i2c_err_code_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_I2C_FAIL_ERR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API Reads the dropped command error
- * from the register 0x02 bit 6
- *
- *
- * @param v_drop_cmd_err_u8 : The status of drop command error
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_drop_cmd_err(u8
- *v_drop_cmd_err_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_DROP_CMD_ERR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_drop_cmd_err_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_DROP_CMD_ERR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the magnetometer data ready
- * interrupt not active.
- * It reads from the error register 0x0x2 bit 7
- *
- *
- *
- *
- * @param v_mag_data_rdy_err_u8 : The status of mag data ready interrupt
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_mag_dada_rdy_err(
- u8 *v_mag_data_rdy_err_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_MAG_DADA_RDY_ERR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_mag_data_rdy_err_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_DADA_RDY_ERR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the error status
- * from the error register 0x02 bit 0 to 7
- *
- * @param v_mag_data_rdy_err_u8 : The status of mag data ready interrupt
- * @param v_fatal_er_u8r : The status of fatal error
- * @param v_err_code_u8 : The status of error code
- * @param v_i2c_fail_err_u8 : The status of I2C fail error
- * @param v_drop_cmd_err_u8 : The status of drop command error
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_error_status(u8 *v_fatal_er_u8r,
- u8 *v_err_code_u8, u8 *v_i2c_fail_err_u8,
- u8 *v_drop_cmd_err_u8, u8 *v_mag_data_rdy_err_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the error codes*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_ERR_STAT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- /* fatal error*/
- *v_fatal_er_u8r =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FATAL_ERR);
- /* user error*/
- *v_err_code_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_ERR_CODE);
- /* i2c fail error*/
- *v_i2c_fail_err_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_I2C_FAIL_ERR);
- /* drop command error*/
- *v_drop_cmd_err_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_DROP_CMD_ERR);
- /* mag data ready error*/
- *v_mag_data_rdy_err_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_DADA_RDY_ERR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the magnetometer power mode from
- * PMU status register 0x03 bit 0 and 1
- *
- * @param v_mag_power_mode_stat_u8 : The value of mag power mode
- * mag_powermode | value
- * ------------------|----------
- * SUSPEND | 0x00
- * NORMAL | 0x01
- * LOW POWER | 0x02
- *
- *
- * @note The power mode of mag set by the 0x7E command register
- * @note using the function "bmi160_set_command_register()"
- * value | mode
- * ---------|----------------
- * 0x18 | MAG_MODE_SUSPEND
- * 0x19 | MAG_MODE_NORMAL
- * 0x1A | MAG_MODE_LOWPOWER
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_mag_power_mode_stat(u8
- *v_mag_power_mode_stat_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_MAG_POWER_MODE_STAT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_mag_power_mode_stat_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_POWER_MODE_STAT);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the gyroscope power mode from
- * PMU status register 0x03 bit 2 and 3
- *
- * @param v_gyro_power_mode_stat_u8 : The value of gyro power mode
- * gyro_powermode | value
- * ------------------|----------
- * SUSPEND | 0x00
- * NORMAL | 0x01
- * FAST POWER UP | 0x03
- *
- * @note The power mode of gyro set by the 0x7E command register
- * @note using the function "bmi160_set_command_register()"
- * value | mode
- * ---------|----------------
- * 0x14 | GYRO_MODE_SUSPEND
- * 0x15 | GYRO_MODE_NORMAL
- * 0x17 | GYRO_MODE_FASTSTARTUP
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_power_mode_stat(u8
- *v_gyro_power_mode_stat_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_GYRO_POWER_MODE_STAT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_gyro_power_mode_stat_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_POWER_MODE_STAT);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the accelerometer power mode from
- * PMU status register 0x03 bit 4 and 5
- *
- *
- * @param v_accel_power_mode_stat_u8 : The value of accel power mode
- * accel_powermode | value
- * ------------------|----------
- * SUSPEND | 0x00
- * NORMAL | 0x01
- * LOW POWER | 0x02
- *
- * @note The power mode of accel set by the 0x7E command register
- * @note using the function "bmi160_set_command_register()"
- * value | mode
- * ---------|----------------
- * 0x11 | ACCEL_MODE_NORMAL
- * 0x12 | ACCEL_LOWPOWER
- * 0x10 | ACCEL_SUSPEND
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_power_mode_stat(u8
- *v_accel_power_mode_stat_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_ACCEL_POWER_MODE_STAT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_accel_power_mode_stat_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_POWER_MODE_STAT);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads magnetometer data X values
- * from the register 0x04 and 0x05
- * @brief The mag sensor data read form auxiliary mag
- *
- * @param v_mag_x_s16 : The value of mag x
- * @param v_sensor_select_u8 : Mag selection value
- * value | sensor
- * ---------|----------------
- * 0 | BMM150
- * 1 | AKM09911
- *
- * @note For mag data output rate configuration use the following function
- * @note bmi160_set_mag_output_data_rate()
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_mag_x(s16 *v_mag_x_s16,
- u8 v_sensor_select_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the mag X lSB and MSB data
- v_data_u8[0] - LSB
- v_data_u8[1] - MSB*/
- u8 v_data_u8[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_sensor_select_u8) {
- case BST_BMM:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_DATA_MAG_X_LSB__REG,
- v_data_u8, C_BMI160_TWO_U8X);
- /* X axis*/
- v_data_u8[LSB_ZERO] =
- BMI160_GET_BITSLICE(v_data_u8[LSB_ZERO],
- BMI160_USER_DATA_MAG_X_LSB);
- *v_mag_x_s16 = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_5_POSITION) |
- (v_data_u8[LSB_ZERO]));
- break;
- case BST_AKM:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_0_MAG_X_LSB__REG,
- v_data_u8, C_BMI160_TWO_U8X);
- *v_mag_x_s16 = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) |
- (v_data_u8[LSB_ZERO]));
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads magnetometer data Y values
- * from the register 0x06 and 0x07
- * @brief The mag sensor data read form auxiliary mag
- *
- * @param v_mag_y_s16 : The value of mag y
- * @param v_sensor_select_u8 : Mag selection value
- * value | sensor
- * ---------|----------------
- * 0 | BMM150
- * 1 | AKM09911
- *
- * @note For mag data output rate configuration use the following function
- * @note bmi160_set_mag_output_data_rate()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_mag_y(s16 *v_mag_y_s16,
- u8 v_sensor_select_u8)
- {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_OUT_OF_RANGE;
- /* Array contains the mag Y lSB and MSB data
- v_data_u8[0] - LSB
- v_data_u8[1] - MSB*/
- u8 v_data_u8[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_sensor_select_u8) {
- case BST_BMM:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_DATA_MAG_Y_LSB__REG,
- v_data_u8, C_BMI160_TWO_U8X);
- /*Y-axis lsb value shifting*/
- v_data_u8[LSB_ZERO] =
- BMI160_GET_BITSLICE(v_data_u8[LSB_ZERO],
- BMI160_USER_DATA_MAG_Y_LSB);
- *v_mag_y_s16 = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_5_POSITION) |
- (v_data_u8[LSB_ZERO]));
- break;
- case BST_AKM:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_DATA_2_MAG_Y_LSB__REG,
- v_data_u8, C_BMI160_TWO_U8X);
- *v_mag_y_s16 = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) |
- (v_data_u8[LSB_ZERO]));
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads magnetometer data Z values
- * from the register 0x08 and 0x09
- * @brief The mag sensor data read form auxiliary mag
- *
- * @param v_mag_z_s16 : The value of mag z
- * @param v_sensor_select_u8 : Mag selection value
- * value | sensor
- * ---------|----------------
- * 0 | BMM150
- * 1 | AKM09911
- *
- * @note For mag data output rate configuration use the following function
- * @note bmi160_set_mag_output_data_rate()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_mag_z(s16 *v_mag_z_s16,
- u8 v_sensor_select_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the mag Z lSB and MSB data
- v_data_u8[0] - LSB
- v_data_u8[1] - MSB*/
- u8 v_data_u8[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_sensor_select_u8) {
- case BST_BMM:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_DATA_MAG_Z_LSB__REG,
- v_data_u8, C_BMI160_TWO_U8X);
- /*Z-axis lsb value shifting*/
- v_data_u8[LSB_ZERO] =
- BMI160_GET_BITSLICE(v_data_u8[LSB_ZERO],
- BMI160_USER_DATA_MAG_Z_LSB);
- *v_mag_z_s16 = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_7_POSITION) |
- (v_data_u8[LSB_ZERO]));
- break;
- case BST_AKM:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_DATA_4_MAG_Z_LSB__REG,
- v_data_u8, C_BMI160_TWO_U8X);
- *v_mag_z_s16 = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) | (
- v_data_u8[LSB_ZERO]));
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads magnetometer data RHALL values
- * from the register 0x0A and 0x0B
- *
- *
- * @param v_mag_r_s16 : The value of BMM150 r data
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_mag_r(s16 *v_mag_r_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the mag R lSB and MSB data
- v_data_u8[0] - LSB
- v_data_u8[1] - MSB*/
- u8 v_data_u8[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_6_RHALL_LSB__REG,
- v_data_u8, C_BMI160_TWO_U8X);
- /*R-axis lsb value shifting*/
- v_data_u8[LSB_ZERO] =
- BMI160_GET_BITSLICE(v_data_u8[LSB_ZERO],
- BMI160_USER_DATA_MAG_R_LSB);
- *v_mag_r_s16 = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_6_POSITION) |
- (v_data_u8[LSB_ZERO]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads magnetometer data X,Y,Z values
- * from the register 0x04 to 0x09
- *
- * @brief The mag sensor data read form auxiliary mag
- *
- * @param mag : The value of mag xyz data
- * @param v_sensor_select_u8 : Mag selection value
- * value | sensor
- * ---------|----------------
- * 0 | BMM150
- * 1 | AKM09911
- *
- * @note For mag data output rate configuration use the following function
- * @note bmi160_set_mag_output_data_rate()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_mag_xyz(
- struct bmi160_mag_t *mag, u8 v_sensor_select_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the mag XYZ lSB and MSB data
- v_data_u8[0] - X-LSB
- v_data_u8[1] - X-MSB
- v_data_u8[0] - Y-LSB
- v_data_u8[1] - Y-MSB
- v_data_u8[0] - Z-LSB
- v_data_u8[1] - Z-MSB
- */
- u8 v_data_u8[ARRAY_SIZE_SIX] = {
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_sensor_select_u8) {
- case BST_BMM:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_DATA_MAG_X_LSB__REG,
- v_data_u8, C_BMI160_SIX_U8X);
- /*X-axis lsb value shifting*/
- v_data_u8[LSB_ZERO] = BMI160_GET_BITSLICE(
- v_data_u8[LSB_ZERO],
- BMI160_USER_DATA_MAG_X_LSB);
- /* Data X */
- mag->x = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_5_POSITION) |
- (v_data_u8[LSB_ZERO]));
- /* Data Y */
- /*Y-axis lsb value shifting*/
- v_data_u8[LSB_TWO] = BMI160_GET_BITSLICE(
- v_data_u8[LSB_TWO],
- BMI160_USER_DATA_MAG_Y_LSB);
- mag->y = (s16)
- ((((s32)((s8)v_data_u8[MSB_THREE]))
- << BMI160_SHIFT_5_POSITION) |
- (v_data_u8[LSB_TWO]));
- /* Data Z */
- /*Z-axis lsb value shifting*/
- v_data_u8[LSB_FOUR] = BMI160_GET_BITSLICE(
- v_data_u8[LSB_FOUR],
- BMI160_USER_DATA_MAG_Z_LSB);
- mag->z = (s16)
- ((((s32)((s8)v_data_u8[MSB_FIVE]))
- << BMI160_SHIFT_7_POSITION) |
- (v_data_u8[LSB_FOUR]));
- break;
- case BST_AKM:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_0_MAG_X_LSB__REG,
- v_data_u8, C_BMI160_SIX_U8X);
- /* Data X */
- mag->x = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) |
- (v_data_u8[LSB_ZERO]));
- /* Data Y */
- mag->y = ((((s32)((s8)v_data_u8[MSB_THREE]))
- << BMI160_SHIFT_8_POSITION) |
- (v_data_u8[LSB_TWO]));
- /* Data Z */
- mag->z = (s16)
- ((((s32)((s8)v_data_u8[MSB_FIVE]))
- << BMI160_SHIFT_8_POSITION) |
- (v_data_u8[LSB_FOUR]));
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!*
- * @brief This API reads magnetometer data X,Y,Z,r
- * values from the register 0x04 to 0x0B
- *
- * @brief The mag sensor data read form auxiliary mag
- *
- * @param mag : The value of mag-BMM150 xyzr data
- *
- * @note For mag data output rate configuration use the following function
- * @note bmi160_set_mag_output_data_rate()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_mag_xyzr(
- struct bmi160_mag_xyzr_t *mag)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8[ARRAY_SIZE_EIGHT] = {
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_MAG_X_LSB__REG,
- v_data_u8, C_BMI160_EIGHT_U8X);
- /* Data X */
- /*X-axis lsb value shifting*/
- v_data_u8[LSB_ZERO] = BMI160_GET_BITSLICE(
- v_data_u8[LSB_ZERO],
- BMI160_USER_DATA_MAG_X_LSB);
- mag->x = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_5_POSITION) | (v_data_u8[LSB_ZERO]));
- /* Data Y */
- /*Y-axis lsb value shifting*/
- v_data_u8[LSB_TWO] = BMI160_GET_BITSLICE(
- v_data_u8[LSB_TWO],
- BMI160_USER_DATA_MAG_Y_LSB);
- mag->y = (s16)
- ((((s32)((s8)v_data_u8[MSB_THREE]))
- << BMI160_SHIFT_5_POSITION) | (v_data_u8[LSB_TWO]));
- /* Data Z */
- /*Z-axis lsb value shifting*/
- v_data_u8[LSB_FOUR] = BMI160_GET_BITSLICE(
- v_data_u8[LSB_FOUR],
- BMI160_USER_DATA_MAG_Z_LSB);
- mag->z = (s16)
- ((((s32)((s8)v_data_u8[MSB_FIVE]))
- << BMI160_SHIFT_7_POSITION) | (v_data_u8[LSB_FOUR]));
- /* RHall */
- /*R-axis lsb value shifting*/
- v_data_u8[LSB_SIX] = BMI160_GET_BITSLICE(
- v_data_u8[LSB_SIX],
- BMI160_USER_DATA_MAG_R_LSB);
- mag->r = (s16)
- ((((s32)((s8)v_data_u8[MSB_SEVEN]))
- << BMI160_SHIFT_6_POSITION) | (v_data_u8[LSB_SIX]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads gyro data X values
- * form the register 0x0C and 0x0D
- *
- *
- *
- *
- * @param v_gyro_x_s16 : The value of gyro x data
- *
- * @note Gyro Configuration use the following function
- * @note bmi160_set_gyro_output_data_rate()
- * @note bmi160_set_gyro_bw()
- * @note bmi160_set_gyro_range()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_gyro_x(s16 *v_gyro_x_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the gyro X lSB and MSB data
- v_data_u8[0] - LSB
- v_data_u8[MSB_ONE] - MSB*/
- u8 v_data_u8[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_8_GYRO_X_LSB__REG,
- v_data_u8, C_BMI160_TWO_U8X);
- *v_gyro_x_s16 = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) | (v_data_u8[LSB_ZERO]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads gyro data Y values
- * form the register 0x0E and 0x0F
- *
- *
- *
- *
- * @param v_gyro_y_s16 : The value of gyro y data
- *
- * @note Gyro Configuration use the following function
- * @note bmi160_set_gyro_output_data_rate()
- * @note bmi160_set_gyro_bw()
- * @note bmi160_set_gyro_range()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error result of communication routines
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_gyro_y(s16 *v_gyro_y_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the gyro Y lSB and MSB data
- v_data_u8[LSB_ZERO] - LSB
- v_data_u8[MSB_ONE] - MSB*/
- u8 v_data_u8[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read gyro y data*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_10_GYRO_Y_LSB__REG,
- v_data_u8, C_BMI160_TWO_U8X);
- *v_gyro_y_s16 = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) | (v_data_u8[LSB_ZERO]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads gyro data Z values
- * form the register 0x10 and 0x11
- *
- *
- *
- *
- * @param v_gyro_z_s16 : The value of gyro z data
- *
- * @note Gyro Configuration use the following function
- * @note bmi160_set_gyro_output_data_rate()
- * @note bmi160_set_gyro_bw()
- * @note bmi160_set_gyro_range()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_gyro_z(s16 *v_gyro_z_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the gyro Z lSB and MSB data
- v_data_u8[LSB_ZERO] - LSB
- v_data_u8[MSB_ONE] - MSB*/
- u8 v_data_u8[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read gyro z data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_12_GYRO_Z_LSB__REG,
- v_data_u8, C_BMI160_TWO_U8X);
- *v_gyro_z_s16 = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) | (v_data_u8[LSB_ZERO]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads gyro data X,Y,Z values
- * from the register 0x0C to 0x11
- *
- *
- *
- *
- * @param gyro : The value of gyro xyz
- *
- * @note Gyro Configuration use the following function
- * @note bmi160_set_gyro_output_data_rate()
- * @note bmi160_set_gyro_bw()
- * @note bmi160_set_gyro_range()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_gyro_xyz(struct bmi160_gyro_t *gyro)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the mag XYZ lSB and MSB data
- v_data_u8[0] - X-LSB
- v_data_u8[1] - X-MSB
- v_data_u8[0] - Y-LSB
- v_data_u8[1] - Y-MSB
- v_data_u8[0] - Z-LSB
- v_data_u8[1] - Z-MSB
- */
- u8 v_data_u8[ARRAY_SIZE_SIX] = {C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the gyro xyz data*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_8_GYRO_X_LSB__REG,
- v_data_u8, C_BMI160_SIX_U8X);
- /* Data X */
- gyro->x = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) | (v_data_u8[LSB_ZERO]));
- /* Data Y */
- gyro->y = (s16)
- ((((s32)((s8)v_data_u8[MSB_THREE]))
- << BMI160_SHIFT_8_POSITION) | (v_data_u8[LSB_TWO]));
- /* Data Z */
- gyro->z = (s16)
- ((((s32)((s8)v_data_u8[MSB_FIVE]))
- << BMI160_SHIFT_8_POSITION) | (v_data_u8[LSB_FOUR]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads accelerometer data X values
- * form the register 0x12 and 0x13
- *
- *
- *
- *
- * @param v_accel_x_s16 : The value of accel x
- *
- * @note For accel configuration use the following functions
- * @note bmi160_set_accel_output_data_rate()
- * @note bmi160_set_accel_bw()
- * @note bmi160_set_accel_under_sampling_parameter()
- * @note bmi160_set_accel_range()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_accel_x(s16 *v_accel_x_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the accel X lSB and MSB data
- v_data_u8[0] - LSB
- v_data_u8[1] - MSB*/
- u8 v_data_u8[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_14_ACCEL_X_LSB__REG,
- v_data_u8, C_BMI160_TWO_U8X);
- *v_accel_x_s16 = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) | (v_data_u8[LSB_ZERO]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads accelerometer data Y values
- * form the register 0x14 and 0x15
- *
- *
- *
- *
- * @param v_accel_y_s16 : The value of accel y
- *
- * @note For accel configuration use the following functions
- * @note bmi160_set_accel_output_data_rate()
- * @note bmi160_set_accel_bw()
- * @note bmi160_set_accel_under_sampling_parameter()
- * @note bmi160_set_accel_range()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_accel_y(s16 *v_accel_y_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the accel Y lSB and MSB data
- v_data_u8[0] - LSB
- v_data_u8[1] - MSB*/
- u8 v_data_u8[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_16_ACCEL_Y_LSB__REG,
- v_data_u8, C_BMI160_TWO_U8X);
- *v_accel_y_s16 = (s16)
- ((((s32)((s8)v_data_u8[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) | (v_data_u8[LSB_ZERO]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads accelerometer data Z values
- * form the register 0x16 and 0x17
- *
- *
- *
- *
- * @param v_accel_z_s16 : The value of accel z
- *
- * @note For accel configuration use the following functions
- * @note bmi160_set_accel_output_data_rate()
- * @note bmi160_set_accel_bw()
- * @note bmi160_set_accel_under_sampling_parameter()
- * @note bmi160_set_accel_range()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_accel_z(s16 *v_accel_z_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the accel Z lSB and MSB data
- a_data_u8r[LSB_ZERO] - LSB
- a_data_u8r[MSB_ONE] - MSB*/
- u8 a_data_u8r[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_18_ACCEL_Z_LSB__REG,
- a_data_u8r, C_BMI160_TWO_U8X);
- *v_accel_z_s16 = (s16)
- ((((s32)((s8)a_data_u8r[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) | (a_data_u8r[LSB_ZERO]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads accelerometer data X,Y,Z values
- * from the register 0x12 to 0x17
- *
- *
- *
- *
- * @param accel :The value of accel xyz
- *
- * @note For accel configuration use the following functions
- * @note bmi160_set_accel_output_data_rate()
- * @note bmi160_set_accel_bw()
- * @note bmi160_set_accel_under_sampling_parameter()
- * @note bmi160_set_accel_range()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_accel_xyz(
- struct bmi160_accel_t *accel)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the accel XYZ lSB and MSB data
- a_data_u8r[0] - X-LSB
- a_data_u8r[1] - X-MSB
- a_data_u8r[0] - Y-LSB
- a_data_u8r[1] - Y-MSB
- a_data_u8r[0] - Z-LSB
- a_data_u8r[1] - Z-MSB
- */
- u8 a_data_u8r[ARRAY_SIZE_SIX] = {C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_14_ACCEL_X_LSB__REG,
- a_data_u8r, C_BMI160_SIX_U8X);
- /* Data X */
- accel->x = (s16)
- ((((s32)((s8)a_data_u8r[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) | (a_data_u8r[LSB_ZERO]));
- /* Data Y */
- accel->y = (s16)
- ((((s32)((s8)a_data_u8r[MSB_THREE]))
- << BMI160_SHIFT_8_POSITION) | (a_data_u8r[LSB_TWO]));
- /* Data Z */
- accel->z = (s16)
- ((((s32)((s8)a_data_u8r[MSB_FIVE]))
- << BMI160_SHIFT_8_POSITION) | (a_data_u8r[LSB_FOUR]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads sensor_time from the register
- * 0x18 to 0x1A
- *
- *
- * @param v_sensor_time_u32 : The value of sensor time
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_sensor_time(u32 *v_sensor_time_u32)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the sensor time it is 32 bit data
- a_data_u8r[0] - sensor time
- a_data_u8r[1] - sensor time
- a_data_u8r[0] - sensor time
- */
- u8 a_data_u8r[ARRAY_SIZE_THREE] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_SENSORTIME_0_SENSOR_TIME_LSB__REG,
- a_data_u8r, C_BMI160_THREE_U8X);
- *v_sensor_time_u32 = (u32)
- ((((u32)a_data_u8r[C_BMI160_TWO_U8X])
- << BMI160_SHIFT_16_POSITION)
- |(((u32)a_data_u8r[C_BMI160_ONE_U8X])
- << BMI160_SHIFT_8_POSITION)
- | (a_data_u8r[C_BMI160_ZERO_U8X]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the Gyroscope self test
- * status from the register 0x1B bit 1
- *
- *
- * @param v_gyro_selftest_u8 : The value of gyro self test status
- * value | status
- * ---------|----------------
- * 0 | Gyroscope self test is running or failed
- * 1 | Gyroscope self test completed successfully
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_selftest(u8
- *v_gyro_selftest_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_STAT_GYRO_SELFTEST_OK__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_gyro_selftest_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_STAT_GYRO_SELFTEST_OK);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the status of
- * mag manual interface operation form the register 0x1B bit 2
- *
- *
- *
- * @param v_mag_manual_stat_u8 : The value of mag manual operation status
- * value | status
- * ---------|----------------
- * 0 | Indicates no manual magnetometer
- * - | interface operation is ongoing
- * 1 | Indicates manual magnetometer
- * - | interface operation is ongoing
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_mag_manual_operation_stat(u8
- *v_mag_manual_stat_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read manual operation*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_STAT_MAG_MANUAL_OPERATION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_mag_manual_stat_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_STAT_MAG_MANUAL_OPERATION);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the fast offset compensation
- * status form the register 0x1B bit 3
- *
- *
- * @param v_foc_rdy_u8 : The status of fast compensation
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_foc_rdy(u8
- *v_foc_rdy_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the FOC status*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_STAT_FOC_RDY__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_foc_rdy_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_STAT_FOC_RDY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API Reads the nvm_rdy status from the
- * resister 0x1B bit 4
- *
- *
- * @param v_nvm_rdy_u8 : The value of NVM ready status
- * value | status
- * ---------|----------------
- * 0 | NVM write operation in progress
- * 1 | NVM is ready to accept a new write trigger
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_nvm_rdy(u8
- *v_nvm_rdy_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the nvm ready status*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_STAT_NVM_RDY__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_nvm_rdy_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_STAT_NVM_RDY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the status of mag data ready
- * from the register 0x1B bit 5
- * The status get reset when one mag data register is read out
- *
- * @param v_data_rdy_u8 : The value of mag data ready status
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_data_rdy_mag(u8
- *v_data_rdy_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_STAT_DATA_RDY_MAG__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_data_rdy_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_STAT_DATA_RDY_MAG);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the status of gyro data ready form the
- * register 0x1B bit 6
- * The status get reset when gyro data register read out
- *
- *
- * @param v_data_rdy_u8 : The value of gyro data ready
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_data_rdy(u8
- *v_data_rdy_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_STAT_DATA_RDY_GYRO__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_data_rdy_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_STAT_DATA_RDY_GYRO);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the status of accel data ready form the
- * register 0x1B bit 7
- * The status get reset when accel data register read out
- *
- *
- * @param v_data_rdy_u8 : The value of accel data ready status
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_data_rdy(u8
- *v_data_rdy_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /*reads the status of accel data ready*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_STAT_DATA_RDY_ACCEL__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_data_rdy_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_STAT_DATA_RDY_ACCEL);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the step detector interrupt status
- * from the register 0x1C bit 0
- * flag is associated with a specific interrupt function.
- * It is set when the single tab interrupt triggers. The
- * setting of INT_LATCH controls if the interrupt
- * signal and hence the
- * respective interrupt flag will be
- * permanently latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- * @param v_step_intr_u8 : The status of step detector interrupt
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat0_step_intr(u8
- *v_step_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_0_STEP_INTR__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_step_intr_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_0_STEP_INTR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the
- * significant motion interrupt status
- * from the register 0x1C bit 1
- * flag is associated with a specific interrupt function.
- * It is set when the single tab interrupt triggers. The
- * setting of INT_LATCH controls if the interrupt
- * signal and hence the
- * respective interrupt flag will be
- * permanently latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- *
- * @param v_significant_intr_u8 : The status of step
- * motion interrupt
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat0_significant_intr(u8
- *v_significant_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_0_SIGNIFICANT_INTR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_significant_intr_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_0_SIGNIFICANT_INTR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the any motion interrupt status
- * from the register 0x1C bit 2
- * flag is associated with a specific interrupt function.
- * It is set when the single tab interrupt triggers. The
- * setting of INT_LATCH controls if the interrupt
- * signal and hence the
- * respective interrupt flag will be
- * permanently latched, temporarily latched
- * or not latched.
- *
- *
- *
- * @param v_any_motion_intr_u8 : The status of any-motion interrupt
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat0_any_motion_intr(u8
- *v_any_motion_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_0_ANY_MOTION__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_any_motion_intr_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_0_ANY_MOTION);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the power mode trigger interrupt status
- * from the register 0x1C bit 3
- * flag is associated with a specific interrupt function.
- * It is set when the single tab interrupt triggers. The
- * setting of INT_LATCH controls if the interrupt
- * signal and hence the
- * respective interrupt flag will be
- * permanently latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- *
- * @param v_pmu_trigger_intr_u8 : The status of power mode trigger interrupt
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat0_pmu_trigger_intr(u8
- *v_pmu_trigger_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_0_PMU_TRIGGER__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_pmu_trigger_intr_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_0_PMU_TRIGGER);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the double tab status
- * from the register 0x1C bit 4
- * flag is associated with a specific interrupt function.
- * It is set when the single tab interrupt triggers. The
- * setting of INT_LATCH controls if the interrupt
- * signal and hence the
- * respective interrupt flag will be
- * permanently latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- * @param v_double_tap_intr_u8 :The status of double tab interrupt
- *
- * @note Double tap interrupt can be configured by the following functions
- * @note INTERRUPT MAPPING
- * @note bmi160_set_intr_double_tap()
- * @note AXIS MAPPING
- * @note bmi160_get_stat2_tap_first_x()
- * @note bmi160_get_stat2_tap_first_y()
- * @note bmi160_get_stat2_tap_first_z()
- * @note DURATION
- * @note bmi160_set_intr_tap_durn()
- * @note THRESHOLD
- * @note bmi160_set_intr_tap_thres()
- * @note TAP QUIET
- * @note bmi160_set_intr_tap_quiet()
- * @note TAP SHOCK
- * @note bmi160_set_intr_tap_shock()
- * @note TAP SOURCE
- * @note bmi160_set_intr_tap_source()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat0_double_tap_intr(u8
- *v_double_tap_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_0_DOUBLE_TAP_INTR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_double_tap_intr_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_0_DOUBLE_TAP_INTR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the single tab status
- * from the register 0x1C bit 5
- * flag is associated with a specific interrupt function.
- * It is set when the single tab interrupt triggers. The
- * setting of INT_LATCH controls if the interrupt
- * signal and hence the
- * respective interrupt flag will be
- * permanently latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- * @param v_single_tap_intr_u8 :The status of single tap interrupt
- *
- * @note Single tap interrupt can be configured by the following functions
- * @note INTERRUPT MAPPING
- * @note bmi160_set_intr_single_tap()
- * @note AXIS MAPPING
- * @note bmi160_get_stat2_tap_first_x()
- * @note bmi160_get_stat2_tap_first_y()
- * @note bmi160_get_stat2_tap_first_z()
- * @note DURATION
- * @note bmi160_set_intr_tap_durn()
- * @note THRESHOLD
- * @note bmi160_set_intr_tap_thres()
- * @note TAP QUIET
- * @note bmi160_set_intr_tap_quiet()
- * @note TAP SHOCK
- * @note bmi160_set_intr_tap_shock()
- * @note TAP SOURCE
- * @note bmi160_set_intr_tap_source()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat0_single_tap_intr(u8
- *v_single_tap_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_0_SINGLE_TAP_INTR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_single_tap_intr_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_0_SINGLE_TAP_INTR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the orient status
- * from the register 0x1C bit 6
- * flag is associated with a specific interrupt function.
- * It is set when the orient interrupt triggers. The
- * setting of INT_LATCH controls if the
- * interrupt signal and hence the
- * respective interrupt flag will be
- * permanently latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- * @param v_orient_intr_u8 : The status of orient interrupt
- *
- * @note For orient interrupt configuration use the following functions
- * @note STATUS
- * @note bmi160_get_stat0_orient_intr()
- * @note AXIS MAPPING
- * @note bmi160_get_stat3_orient_xy()
- * @note bmi160_get_stat3_orient_z()
- * @note bmi160_set_intr_orient_axes_enable()
- * @note INTERRUPT MAPPING
- * @note bmi160_set_intr_orient()
- * @note INTERRUPT OUTPUT
- * @note bmi160_set_intr_orient_ud_enable()
- * @note THETA
- * @note bmi160_set_intr_orient_theta()
- * @note HYSTERESIS
- * @note bmi160_set_intr_orient_hyst()
- * @note BLOCKING
- * @note bmi160_set_intr_orient_blocking()
- * @note MODE
- * @note bmi160_set_intr_orient_mode()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat0_orient_intr(u8
- *v_orient_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_0_ORIENT__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_orient_intr_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_0_ORIENT);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the flat interrupt status
- * from the register 0x1C bit 7
- * flag is associated with a specific interrupt function.
- * It is set when the flat interrupt triggers. The
- * setting of INT_LATCH controls if the
- * interrupt signal and hence the
- * respective interrupt flag will be
- * permanently latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- * @param v_flat_intr_u8 : The status of flat interrupt
- *
- * @note For flat configuration use the following functions
- * @note STATS
- * @note bmi160_get_stat0_flat_intr()
- * @note bmi160_get_stat3_flat()
- * @note INTERRUPT MAPPING
- * @note bmi160_set_intr_flat()
- * @note THETA
- * @note bmi160_set_intr_flat_theta()
- * @note HOLD TIME
- * @note bmi160_set_intr_flat_hold()
- * @note HYSTERESIS
- * @note bmi160_set_intr_flat_hyst()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat0_flat_intr(u8
- *v_flat_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_0_FLAT__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_flat_intr_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_0_FLAT);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the high_g interrupt status
- * from the register 0x1D bit 2
- * flag is associated with a specific interrupt function.
- * It is set when the high g interrupt triggers. The
- * setting of INT_LATCH controls if the interrupt signal and hence the
- * respective interrupt flag will be permanently
- * latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- * @param v_high_g_intr_u8 : The status of high_g interrupt
- *
- * @note High_g interrupt configured by following functions
- * @note STATUS
- * @note bmi160_get_stat1_high_g_intr()
- * @note AXIS MAPPING
- * @note bmi160_get_stat3_high_g_first_x()
- * @note bmi160_get_stat3_high_g_first_y()
- * @note bmi160_get_stat3_high_g_first_z()
- * @note SIGN MAPPING
- * @note bmi160_get_stat3_high_g_first_sign()
- * @note INTERRUPT MAPPING
- * @note bmi160_set_intr_high_g()
- * @note HYSTERESIS
- * @note bmi160_set_intr_high_g_hyst()
- * @note DURATION
- * @note bmi160_set_intr_high_g_durn()
- * @note THRESHOLD
- * @note bmi160_set_intr_high_g_thres()
- * @note SOURCE
- * @note bmi160_set_intr_low_high_source()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat1_high_g_intr(u8
- *v_high_g_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_1_HIGH_G_INTR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_high_g_intr_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_1_HIGH_G_INTR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the low g interrupt status
- * from the register 0x1D bit 3
- * flag is associated with a specific interrupt function.
- * It is set when the low g interrupt triggers. The
- * setting of INT_LATCH controls if the interrupt signal and hence the
- * respective interrupt flag will be
- * permanently latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- * @param v_low_g_intr_u8 : The status of low_g interrupt
- *
- * @note Low_g interrupt configured by following functions
- * @note STATUS
- * @note bmi160_get_stat1_low_g_intr()
- * @note INTERRUPT MAPPING
- * @note bmi160_set_intr_low_g()
- * @note SOURCE
- * @note bmi160_set_intr_low_high_source()
- * @note DURATION
- * @note bmi160_set_intr_low_g_durn()
- * @note THRESHOLD
- * @note bmi160_set_intr_low_g_thres()
- * @note HYSTERESIS
- * @note bmi160_set_intr_low_g_hyst()
- * @note MODE
- * @note bmi160_set_intr_low_g_mode()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat1_low_g_intr(u8
- *v_low_g_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_1_LOW_G_INTR__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_low_g_intr_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_1_LOW_G_INTR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads data ready interrupt status
- * from the register 0x1D bit 4
- * flag is associated with a specific interrupt function.
- * It is set when the data ready interrupt triggers. The
- * setting of INT_LATCH controls if the interrupt signal and hence the
- * respective interrupt flag will be
- * permanently latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- * @param v_data_rdy_intr_u8 : The status of data ready interrupt
- *
- * @note Data ready interrupt configured by following functions
- * @note STATUS
- * @note bmi160_get_stat1_data_rdy_intr()
- * @note INTERRUPT MAPPING
- * @note bmi160_set_intr_data_rdy()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat1_data_rdy_intr(u8
- *v_data_rdy_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_1_DATA_RDY_INTR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_data_rdy_intr_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_1_DATA_RDY_INTR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads data ready FIFO full interrupt status
- * from the register 0x1D bit 5
- * flag is associated with a specific interrupt function.
- * It is set when the FIFO full interrupt triggers. The
- * setting of INT_LATCH controls if the
- * interrupt signal and hence the
- * respective interrupt flag will
- * be permanently latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- * @param v_fifo_full_intr_u8 : The status of fifo full interrupt
- *
- * @note FIFO full interrupt can be configured by following functions
- * @note bmi160_set_intr_fifo_full()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat1_fifo_full_intr(u8
- *v_fifo_full_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_1_FIFO_FULL_INTR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_fifo_full_intr_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_1_FIFO_FULL_INTR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads data
- * ready FIFO watermark interrupt status
- * from the register 0x1D bit 6
- * flag is associated with a specific interrupt function.
- * It is set when the FIFO watermark interrupt triggers. The
- * setting of INT_LATCH controls if the
- * interrupt signal and hence the
- * respective interrupt flag will be
- * permanently latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- * @param v_fifo_wm_intr_u8 : The status of fifo water mark interrupt
- *
- * @note FIFO full interrupt can be configured by following functions
- * @note bmi160_set_intr_fifo_wm()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat1_fifo_wm_intr(u8
- *v_fifo_wm_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_1_FIFO_WM_INTR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_fifo_wm_intr_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_1_FIFO_WM_INTR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads data ready no motion interrupt status
- * from the register 0x1D bit 7
- * flag is associated with a specific interrupt function.
- * It is set when the no motion interrupt triggers. The
- * setting of INT_LATCH controls if the interrupt signal and hence the
- * respective interrupt flag will be permanently
- * latched, temporarily latched
- * or not latched.
- *
- *
- *
- *
- * @param v_nomotion_intr_u8 : The status of no motion interrupt
- *
- * @note No motion interrupt can be configured by following function
- * @note STATUS
- * @note bmi160_get_stat1_nomotion_intr()
- * @note INTERRUPT MAPPING
- * @note bmi160_set_intr_nomotion()
- * @note DURATION
- * @note bmi160_set_intr_slow_no_motion_durn()
- * @note THRESHOLD
- * @note bmi160_set_intr_slow_no_motion_thres()
- * @note SLOW/NO MOTION SELECT
- * @note bmi160_set_intr_slow_no_motion_select()
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat1_nomotion_intr(u8
- *v_nomotion_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the no motion interrupt*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_1_NOMOTION_INTR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_nomotion_intr_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_1_NOMOTION_INTR);
- }
- return com_rslt;
- }
- /*!
- *@brief This API reads the status of any motion first x
- * from the register 0x1E bit 0
- *
- *
- *@param v_anymotion_first_x_u8 : The status of any motion first x interrupt
- * value | status
- * -----------|-------------
- * 0 | not triggered
- * 1 | triggered by x axis
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat2_any_motion_first_x(u8
- *v_anymotion_first_x_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the any motion first x interrupt*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_2_ANY_MOTION_FIRST_X__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_anymotion_first_x_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_2_ANY_MOTION_FIRST_X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the status of any motion first y interrupt
- * from the register 0x1E bit 1
- *
- *
- *
- *@param v_any_motion_first_y_u8 : The status of any motion first y interrupt
- * value | status
- * -----------|-------------
- * 0 | not triggered
- * 1 | triggered by y axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat2_any_motion_first_y(u8
- *v_any_motion_first_y_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the any motion first y interrupt*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_2_ANY_MOTION_FIRST_Y__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_any_motion_first_y_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_2_ANY_MOTION_FIRST_Y);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the status of any motion first z interrupt
- * from the register 0x1E bit 2
- *
- *
- *
- *
- *@param v_any_motion_first_z_u8 : The status of any motion first z interrupt
- * value | status
- * -----------|-------------
- * 0 | not triggered
- * 1 | triggered by y axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat2_any_motion_first_z(u8
- *v_any_motion_first_z_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the any motion first z interrupt*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_2_ANY_MOTION_FIRST_Z__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_any_motion_first_z_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_2_ANY_MOTION_FIRST_Z);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the any motion sign status from the
- * register 0x1E bit 3
- *
- *
- *
- *
- * @param v_anymotion_sign_u8 : The status of any motion sign
- * value | sign
- * -----------|-------------
- * 0 | positive
- * 1 | negative
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat2_any_motion_sign(u8
- *v_anymotion_sign_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read any motion sign interrupt status */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_2_ANY_MOTION_SIGN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_anymotion_sign_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_2_ANY_MOTION_SIGN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the any motion tap first x status from the
- * register 0x1E bit 4
- *
- *
- *
- *
- * @param v_tap_first_x_u8 :The status of any motion tap first x
- * value | status
- * -----------|-------------
- * 0 | not triggered
- * 1 | triggered by x axis
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat2_tap_first_x(u8
- *v_tap_first_x_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read tap first x interrupt status */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_2_TAP_FIRST_X__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_tap_first_x_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_2_TAP_FIRST_X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the tap first y interrupt status from the
- * register 0x1E bit 5
- *
- *
- *
- *
- * @param v_tap_first_y_u8 :The status of tap first y interrupt
- * value | status
- * -----------|-------------
- * 0 | not triggered
- * 1 | triggered by y axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat2_tap_first_y(u8
- *v_tap_first_y_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read tap first y interrupt status */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_2_TAP_FIRST_Y__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_tap_first_y_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_2_TAP_FIRST_Y);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the tap first z interrupt status from the
- * register 0x1E bit 6
- *
- *
- *
- *
- * @param v_tap_first_z_u8 :The status of tap first z interrupt
- * value | status
- * -----------|-------------
- * 0 | not triggered
- * 1 | triggered by z axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat2_tap_first_z(u8
- *v_tap_first_z_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read tap first z interrupt status */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_2_TAP_FIRST_Z__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_tap_first_z_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_2_TAP_FIRST_Z);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the tap sign status from the
- * register 0x1E bit 7
- *
- *
- *
- *
- * @param v_tap_sign_u8 : The status of tap sign
- * value | sign
- * -----------|-------------
- * 0 | positive
- * 1 | negative
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat2_tap_sign(u8
- *v_tap_sign_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read tap_sign interrupt status */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_2_TAP_SIGN__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_tap_sign_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_2_TAP_SIGN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the high_g first x status from the
- * register 0x1F bit 0
- *
- *
- *
- *
- * @param v_high_g_first_x_u8 :The status of high_g first x
- * value | status
- * -----------|-------------
- * 0 | not triggered
- * 1 | triggered by x axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat3_high_g_first_x(u8
- *v_high_g_first_x_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read highg_x interrupt status */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_3_HIGH_G_FIRST_X__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_high_g_first_x_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_3_HIGH_G_FIRST_X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the high_g first y status from the
- * register 0x1F bit 1
- *
- *
- *
- *
- * @param v_high_g_first_y_u8 : The status of high_g first y
- * value | status
- * -----------|-------------
- * 0 | not triggered
- * 1 | triggered by y axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat3_high_g_first_y(u8
- *v_high_g_first_y_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read highg_y interrupt status */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_3_HIGH_G_FIRST_Y__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_high_g_first_y_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_3_HIGH_G_FIRST_Y);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the high_g first z status from the
- * register 0x1F bit 3
- *
- *
- *
- *
- * @param v_high_g_first_z_u8 : The status of high_g first z
- * value | status
- * -----------|-------------
- * 0 | not triggered
- * 1 | triggered by z axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat3_high_g_first_z(u8
- *v_high_g_first_z_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read highg_z interrupt status */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_3_HIGH_G_FIRST_Z__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_high_g_first_z_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_3_HIGH_G_FIRST_Z);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the high sign status from the
- * register 0x1F bit 3
- *
- *
- *
- *
- * @param v_high_g_sign_u8 :The status of high sign
- * value | sign
- * -----------|-------------
- * 0 | positive
- * 1 | negative
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat3_high_g_sign(u8
- *v_high_g_sign_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read highg_sign interrupt status */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_3_HIGH_G_SIGN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_high_g_sign_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_3_HIGH_G_SIGN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the status of orient_xy plane
- * from the register 0x1F bit 4 and 5
- *
- *
- * @param v_orient_xy_u8 :The status of orient_xy plane
- * value | status
- * -----------|-------------
- * 0x00 | portrait upright
- * 0x01 | portrait upside down
- * 0x02 | landscape left
- * 0x03 | landscape right
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat3_orient_xy(u8
- *v_orient_xy_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read orient plane xy interrupt status */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_3_ORIENT_XY__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_orient_xy_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_3_ORIENT_XY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the status of orient z plane
- * from the register 0x1F bit 6
- *
- *
- * @param v_orient_z_u8 :The status of orient z
- * value | status
- * -----------|-------------
- * 0x00 | upward looking
- * 0x01 | downward looking
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat3_orient_z(u8
- *v_orient_z_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read orient z plane interrupt status */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_3_ORIENT_Z__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_orient_z_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_3_ORIENT_Z);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the flat status from the register
- * 0x1F bit 7
- *
- *
- * @param v_flat_u8 : The status of flat interrupt
- * value | status
- * -----------|-------------
- * 0x00 | non flat
- * 0x01 | flat position
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_stat3_flat(u8
- *v_flat_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read flat interrupt status */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_INTR_STAT_3_FLAT__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_flat_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_3_FLAT);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the temperature of the sensor
- * from the register 0x21 bit 0 to 7
- *
- *
- *
- * @param v_temp_s16 : The value of temperature
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_temp(s16
- *v_temp_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the temperature lSB and MSB data
- v_data_u8[0] - LSB
- v_data_u8[1] - MSB*/
- u8 v_data_u8[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read temperature data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_TEMP_LSB_VALUE__REG, v_data_u8,
- C_BMI160_TWO_U8X);
- *v_temp_s16 =
- (s16)(((s32)((s8) (v_data_u8[MSB_ONE]) <<
- BMI160_SHIFT_8_POSITION))|v_data_u8[LSB_ZERO]);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the of the sensor
- * form the register 0x23 and 0x24 bit 0 to 7 and 0 to 2
- * @brief this byte counter is updated each time a complete frame
- * was read or writtern
- *
- *
- * @param v_fifo_length_u32 : The value of fifo byte counter
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_fifo_length(u32 *v_fifo_length_u32)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array contains the fifo length data
- v_data_u8[0] - fifo length
- v_data_u8[1] - fifo length*/
- u8 a_data_u8r[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read fifo length*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_BYTE_COUNTER_LSB__REG, a_data_u8r,
- C_BMI160_TWO_U8X);
- a_data_u8r[MSB_ONE] =
- BMI160_GET_BITSLICE(a_data_u8r[MSB_ONE],
- BMI160_USER_FIFO_BYTE_COUNTER_MSB);
- *v_fifo_length_u32 =
- (u32)(((u32)((u8) (a_data_u8r[MSB_ONE]) <<
- BMI160_SHIFT_8_POSITION))|a_data_u8r[LSB_ZERO]);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the fifo data of the sensor
- * from the register 0x24
- * @brief Data format depends on the setting of register FIFO_CONFIG
- *
- *
- *
- * @param v_fifo_data_u8 : Pointer holding the fifo data
- *
- * @note For reading FIFO data use the following functions
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_fifo_data(
- u8 *v_fifo_data_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read fifo data*/
- com_rslt =
- p_bmi160->BMI160_BURST_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_DATA__REG, v_fifo_data_u8, FIFO_FRAME);
- }
- return com_rslt;
- }
- //add by lwy
- BMI160_RETURN_FUNCTION_TYPE bmi160_fifo_data_get_set_integration(
- u8 *v_fifo_data_u8, u32 *fifo_len_u32)
- {
- u32 v_fifo_length_u32=0,i;
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 mag_en = C_BMI160_ZERO_U8X;
- u8 accel_en = C_BMI160_ZERO_U8X;
- u8 gyro_en = C_BMI160_ZERO_U8X;
- u8 read_size = 128;
-
- /* read the mag enable status*/
- com_rslt += bmi160_get_fifo_mag_enable(&mag_en);
- /* read the accel enable status*/
- com_rslt += bmi160_get_fifo_accel_enable(&accel_en);
- /* read the gyro enable status*/
- com_rslt += bmi160_get_fifo_gyro_enable(&gyro_en);
-
- /* condition for mag, gyro and accel enable*/
- if ((mag_en == C_BMI160_ONE_U8X) &&
- (gyro_en == C_BMI160_ONE_U8X)
- && (accel_en == C_BMI160_ONE_U8X)) {
-
- read_size = C_BMI160_ONE_U8X + C_BMI160_TWENTY_U8X;
- }
- /* condition for mag and gyro enable*/
- else if ((mag_en == C_BMI160_ONE_U8X) &&
- (gyro_en == C_BMI160_ONE_U8X)
- && (accel_en == C_BMI160_ZERO_U8X)) {
-
- read_size = C_BMI160_ONE_U8X + C_BMI160_FOURTEEN_U8X;
- }
- /* condition for mag and accel enable*/
- else if ((mag_en == C_BMI160_ONE_U8X) &&
- (accel_en == C_BMI160_ONE_U8X)
- && (gyro_en == C_BMI160_ZERO_U8X)) {
-
- read_size = C_BMI160_ONE_U8X + C_BMI160_FOURTEEN_U8X;
- }
- /* condition for gyro and accel enable*/
- else if ((gyro_en == C_BMI160_ONE_U8X) &&
- (accel_en == C_BMI160_ONE_U8X)
- && (mag_en == C_BMI160_ZERO_U8X)) {
-
- read_size = C_BMI160_ONE_U8X + C_BMI160_TWELVE_U8X;
- }
- /* condition for gyro enable*/
- else if ((gyro_en == C_BMI160_ONE_U8X) &&
- (accel_en == C_BMI160_ZERO_U8X)
- && (mag_en == C_BMI160_ZERO_U8X)) {
-
- read_size = C_BMI160_ONE_U8X + C_BMI160_SIX_U8X;
- }
- /* condition for accel enable*/
- else if ((gyro_en == C_BMI160_ZERO_U8X) &&
- (accel_en == C_BMI160_ONE_U8X)
- && (mag_en == C_BMI160_ZERO_U8X)) {
-
- read_size = C_BMI160_ONE_U8X + C_BMI160_SIX_U8X;
- }
- /* condition for mag enable*/
- else if ((gyro_en == C_BMI160_ZERO_U8X) &&
- (accel_en == C_BMI160_ZERO_U8X)
- && (mag_en == C_BMI160_ONE_U8X)) {
-
- read_size = C_BMI160_ONE_U8X + C_BMI160_EIGHT_U8X;
- }
-
-
- com_rslt = bmi160_fifo_length(&v_fifo_length_u32);
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- *fifo_len_u32 = C_BMI160_ZERO_U8X;
- return E_BMI160_NULL_PTR;
- } else {
- /* read fifo data*/
- if(v_fifo_length_u32 != C_BMI160_ZERO_U8X){
- // SEGGER_RTT_printf(0,"read v_fifo_length_u32 before:%d\r\n",v_fifo_length_u32);
- *fifo_len_u32 = v_fifo_length_u32;
- for(i=0;i<v_fifo_length_u32;i+=read_size)
- {
- com_rslt +=
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_DATA__REG, &v_fifo_data_u8[i], read_size);
- }
- com_rslt = bmi160_fifo_length(&v_fifo_length_u32);
- // SEGGER_RTT_printf(0,"read v_fifo_length_u32 after:%d\r\n",v_fifo_length_u32);
- }else{
- *fifo_len_u32 = C_BMI160_ZERO_U8X;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the
- * accel output date rate form the register 0x40 bit 0 to 3
- *
- *
- * @param v_output_data_rate_u8 :The value of accel output date rate
- * value | output data rate
- * -------|--------------------------
- * 0 | BMI160_ACCEL_OUTPUT_DATA_RATE_RESERVED
- * 1 | BMI160_ACCEL_OUTPUT_DATA_RATE_0_78HZ
- * 2 | BMI160_ACCEL_OUTPUT_DATA_RATE_1_56HZ
- * 3 | BMI160_ACCEL_OUTPUT_DATA_RATE_3_12HZ
- * 4 | BMI160_ACCEL_OUTPUT_DATA_RATE_6_25HZ
- * 5 | BMI160_ACCEL_OUTPUT_DATA_RATE_12_5HZ
- * 6 | BMI160_ACCEL_OUTPUT_DATA_RATE_25HZ
- * 7 | BMI160_ACCEL_OUTPUT_DATA_RATE_50HZ
- * 8 | BMI160_ACCEL_OUTPUT_DATA_RATE_100HZ
- * 9 | BMI160_ACCEL_OUTPUT_DATA_RATE_200HZ
- * 10 | BMI160_ACCEL_OUTPUT_DATA_RATE_400HZ
- * 11 | BMI160_ACCEL_OUTPUT_DATA_RATE_800HZ
- * 12 | BMI160_ACCEL_OUTPUT_DATA_RATE_1600HZ
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_output_data_rate(
- u8 *v_output_data_rate_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the accel output data rate*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_ACCEL_CONFIG_OUTPUT_DATA_RATE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_output_data_rate_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_CONFIG_OUTPUT_DATA_RATE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set the
- * accel output date rate form the register 0x40 bit 0 to 3
- *
- *
- * @param v_output_data_rate_u8 :The value of accel output date rate
- * value | output data rate
- * -------|--------------------------
- * 0 | BMI160_ACCEL_OUTPUT_DATA_RATE_RESERVED
- * 1 | BMI160_ACCEL_OUTPUT_DATA_RATE_0_78HZ
- * 2 | BMI160_ACCEL_OUTPUT_DATA_RATE_1_56HZ
- * 3 | BMI160_ACCEL_OUTPUT_DATA_RATE_3_12HZ
- * 4 | BMI160_ACCEL_OUTPUT_DATA_RATE_6_25HZ
- * 5 | BMI160_ACCEL_OUTPUT_DATA_RATE_12_5HZ
- * 6 | BMI160_ACCEL_OUTPUT_DATA_RATE_25HZ
- * 7 | BMI160_ACCEL_OUTPUT_DATA_RATE_50HZ
- * 8 | BMI160_ACCEL_OUTPUT_DATA_RATE_100HZ
- * 9 | BMI160_ACCEL_OUTPUT_DATA_RATE_200HZ
- * 10 | BMI160_ACCEL_OUTPUT_DATA_RATE_400HZ
- * 11 | BMI160_ACCEL_OUTPUT_DATA_RATE_800HZ
- * 12 | BMI160_ACCEL_OUTPUT_DATA_RATE_1600HZ
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_output_data_rate(
- u8 v_output_data_rate_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* accel output data rate selection */
- if ((v_output_data_rate_u8 != C_BMI160_ZERO_U8X) &&
- (v_output_data_rate_u8 < C_BMI160_THIRTEEN_U8X)) {
- /* write accel output data rate */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_ACCEL_CONFIG_OUTPUT_DATA_RATE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_CONFIG_OUTPUT_DATA_RATE,
- v_output_data_rate_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_ACCEL_CONFIG_OUTPUT_DATA_RATE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the
- * accel bandwidth from the register 0x40 bit 4 to 6
- * @brief bandwidth parameter determines filter configuration(acc_us=0)
- * and averaging for under sampling mode(acc_us=1)
- *
- *
- * @param v_bw_u8 : The value of accel bandwidth
- *
- * @note accel bandwidth depends on under sampling parameter
- * @note under sampling parameter cab be set by the function
- * "BMI160_SET_ACCEL_UNDER_SAMPLING_PARAMETER"
- *
- * @note Filter configuration
- * accel_us | Filter configuration
- * -----------|---------------------
- * 0x00 | OSR4 mode
- * 0x01 | OSR2 mode
- * 0x02 | normal mode
- * 0x03 | CIC mode
- * 0x04 | Reserved
- * 0x05 | Reserved
- * 0x06 | Reserved
- * 0x07 | Reserved
- *
- * @note accel under sampling mode
- * accel_us | Under sampling mode
- * -----------|---------------------
- * 0x00 | no averaging
- * 0x01 | average 2 samples
- * 0x02 | average 4 samples
- * 0x03 | average 8 samples
- * 0x04 | average 16 samples
- * 0x05 | average 32 samples
- * 0x06 | average 64 samples
- * 0x07 | average 128 samples
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_bw(u8 *v_bw_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the accel bandwidth */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_ACCEL_CONFIG_ACCEL_BW__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_bw_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_CONFIG_ACCEL_BW);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set the
- * accel bandwidth from the register 0x40 bit 4 to 6
- * @brief bandwidth parameter determines filter configuration(acc_us=0)
- * and averaging for under sampling mode(acc_us=1)
- *
- *
- * @param v_bw_u8 : The value of accel bandwidth
- *
- * @note accel bandwidth depends on under sampling parameter
- * @note under sampling parameter cab be set by the function
- * "BMI160_SET_ACCEL_UNDER_SAMPLING_PARAMETER"
- *
- * @note Filter configuration
- * accel_us | Filter configuration
- * -----------|---------------------
- * 0x00 | OSR4 mode
- * 0x01 | OSR2 mode
- * 0x02 | normal mode
- * 0x03 | CIC mode
- * 0x04 | Reserved
- * 0x05 | Reserved
- * 0x06 | Reserved
- * 0x07 | Reserved
- *
- * @note accel under sampling mode
- * accel_us | Under sampling mode
- * -----------|---------------------
- * 0x00 | no averaging
- * 0x01 | average 2 samples
- * 0x02 | average 4 samples
- * 0x03 | average 8 samples
- * 0x04 | average 16 samples
- * 0x05 | average 32 samples
- * 0x06 | average 64 samples
- * 0x07 | average 128 samples
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_bw(u8 v_bw_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* select accel bandwidth*/
- if (v_bw_u8 < C_BMI160_EIGHT_U8X) {
- /* write accel bandwidth*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_ACCEL_CONFIG_ACCEL_BW__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_CONFIG_ACCEL_BW,
- v_bw_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_ACCEL_CONFIG_ACCEL_BW__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the accel
- * under sampling parameter form the register 0x40 bit 7
- *
- *
- *
- *
- * @param v_accel_under_sampling_u8 : The value of accel under sampling
- * value | under_sampling
- * ----------|---------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_under_sampling_parameter(
- u8 *v_accel_under_sampling_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the accel under sampling parameter */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_ACCEL_CONFIG_ACCEL_UNDER_SAMPLING__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_accel_under_sampling_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_CONFIG_ACCEL_UNDER_SAMPLING);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set the accel
- * under sampling parameter form the register 0x40 bit 7
- *
- *
- *
- *
- * @param v_accel_under_sampling_u8 : The value of accel under sampling
- * value | under_sampling
- * ----------|---------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_under_sampling_parameter(
- u8 v_accel_under_sampling_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_accel_under_sampling_u8 < C_BMI160_EIGHT_U8X) {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_ACCEL_CONFIG_ACCEL_UNDER_SAMPLING__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- /* write the accel under sampling parameter */
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_CONFIG_ACCEL_UNDER_SAMPLING,
- v_accel_under_sampling_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_ACCEL_CONFIG_ACCEL_UNDER_SAMPLING__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the ranges
- * (g values) of the accel from the register 0x41 bit 0 to 3
- *
- *
- *
- *
- * @param v_range_u8 : The value of accel g range
- * value | g_range
- * ----------|-----------
- * 0x03 | BMI160_ACCEL_RANGE_2G
- * 0x05 | BMI160_ACCEL_RANGE_4G
- * 0x08 | BMI160_ACCEL_RANGE_8G
- * 0x0C | BMI160_ACCEL_RANGE_16G
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_range(
- u8 *v_range_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the accel range*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_ACCEL_RANGE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_range_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_RANGE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set the ranges
- * (g values) of the accel from the register 0x41 bit 0 to 3
- *
- *
- *
- *
- * @param v_range_u8 : The value of accel g range
- * value | g_range
- * ----------|-----------
- * 0x03 | BMI160_ACCEL_RANGE_2G
- * 0x05 | BMI160_ACCEL_RANGE_4G
- * 0x08 | BMI160_ACCEL_RANGE_8G
- * 0x0C | BMI160_ACCEL_RANGE_16G
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_range(u8 v_range_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if ((v_range_u8 == C_BMI160_THREE_U8X) ||
- (v_range_u8 == C_BMI160_FIVE_U8X) ||
- (v_range_u8 == C_BMI160_EIGHT_U8X) ||
- (v_range_u8 == C_BMI160_TWELVE_U8X)) {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_ACCEL_RANGE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(
- v_data_u8, BMI160_USER_ACCEL_RANGE,
- v_range_u8);
- /* write the accel range*/
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_ACCEL_RANGE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the
- * gyroscope output data rate from the register 0x42 bit 0 to 3
- *
- *
- *
- *
- * @param v_output_data_rate_u8 :The value of gyro output data rate
- * value | gyro output data rate
- * -----------|-----------------------------
- * 0x00 | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x01 | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x02 | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x03 | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x04 | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x05 | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x06 | BMI160_GYRO_OUTPUT_DATA_RATE_25HZ
- * 0x07 | BMI160_GYRO_OUTPUT_DATA_RATE_50HZ
- * 0x08 | BMI160_GYRO_OUTPUT_DATA_RATE_100HZ
- * 0x09 | BMI160_GYRO_OUTPUT_DATA_RATE_200HZ
- * 0x0A | BMI160_GYRO_OUTPUT_DATA_RATE_400HZ
- * 0x0B | BMI160_GYRO_OUTPUT_DATA_RATE_800HZ
- * 0x0C | BMI160_GYRO_OUTPUT_DATA_RATE_1600HZ
- * 0x0D | BMI160_GYRO_OUTPUT_DATA_RATE_3200HZ
- * 0x0E | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x0F | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_output_data_rate(
- u8 *v_output_data_rate_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the gyro output data rate*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_GYRO_CONFIG_OUTPUT_DATA_RATE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_output_data_rate_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_CONFIG_OUTPUT_DATA_RATE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set the
- * gyroscope output data rate from the register 0x42 bit 0 to 3
- *
- *
- *
- *
- * @param v_output_data_rate_u8 :The value of gyro output data rate
- * value | gyro output data rate
- * -----------|-----------------------------
- * 0x00 | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x01 | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x02 | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x03 | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x04 | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x05 | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x06 | BMI160_GYRO_OUTPUT_DATA_RATE_25HZ
- * 0x07 | BMI160_GYRO_OUTPUT_DATA_RATE_50HZ
- * 0x08 | BMI160_GYRO_OUTPUT_DATA_RATE_100HZ
- * 0x09 | BMI160_GYRO_OUTPUT_DATA_RATE_200HZ
- * 0x0A | BMI160_GYRO_OUTPUT_DATA_RATE_400HZ
- * 0x0B | BMI160_GYRO_OUTPUT_DATA_RATE_800HZ
- * 0x0C | BMI160_GYRO_OUTPUT_DATA_RATE_1600HZ
- * 0x0D | BMI160_GYRO_OUTPUT_DATA_RATE_3200HZ
- * 0x0E | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- * 0x0F | BMI160_GYRO_OUTPUT_DATA_RATE_RESERVED
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_output_data_rate(
- u8 v_output_data_rate_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* select the gyro output data rate*/
- if ((v_output_data_rate_u8 < C_BMI160_FOURTEEN_U8X) &&
- (v_output_data_rate_u8 != C_BMI160_ZERO_U8X)
- && (v_output_data_rate_u8 != C_BMI160_ONE_U8X)
- && (v_output_data_rate_u8 != C_BMI160_TWO_U8X)
- && (v_output_data_rate_u8 != C_BMI160_THREE_U8X)
- && (v_output_data_rate_u8 != C_BMI160_FOUR_U8X)
- && (v_output_data_rate_u8 != C_BMI160_FIVE_U8X)
- && (v_output_data_rate_u8 != C_BMI160_FOURTEEN_U8X)
- && (v_output_data_rate_u8 != C_BMI160_FIVETEEN_U8X)) {
- /* write the gyro output data rate */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_GYRO_CONFIG_OUTPUT_DATA_RATE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_CONFIG_OUTPUT_DATA_RATE,
- v_output_data_rate_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_GYRO_CONFIG_OUTPUT_DATA_RATE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the
- * data of gyro from the register 0x42 bit 4 to 5
- *
- *
- *
- *
- * @param v_bw_u8 : The value of gyro bandwidth
- * value | gyro bandwidth
- * ----------|----------------
- * 0x00 | BMI160_GYRO_OSR4_MODE
- * 0x01 | BMI160_GYRO_OSR2_MODE
- * 0x02 | BMI160_GYRO_NORMAL_MODE
- * 0x03 | BMI160_GYRO_CIC_MODE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_bw(u8 *v_bw_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read gyro bandwidth*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_GYRO_CONFIG_BW__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_bw_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_CONFIG_BW);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set the
- * data of gyro from the register 0x42 bit 4 to 5
- *
- *
- *
- *
- * @param v_bw_u8 : The value of gyro bandwidth
- * value | gyro bandwidth
- * ----------|----------------
- * 0x00 | BMI160_GYRO_OSR4_MODE
- * 0x01 | BMI160_GYRO_OSR2_MODE
- * 0x02 | BMI160_GYRO_NORMAL_MODE
- * 0x03 | BMI160_GYRO_CIC_MODE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_bw(u8 v_bw_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_bw_u8 < C_BMI160_FOUR_U8X) {
- /* write the gyro bandwidth*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_GYRO_CONFIG_BW__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_CONFIG_BW, v_bw_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_CONFIG_BW__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the range
- * of gyro from the register 0x43 bit 0 to 2
- *
- * @param v_range_u8 : The value of gyro range
- * value | range
- * ----------|-------------------------------
- * 0x00 | BMI160_GYRO_RANGE_2000_DEG_SEC
- * 0x01 | BMI160_GYRO_RANGE_1000_DEG_SEC
- * 0x02 | BMI160_GYRO_RANGE_500_DEG_SEC
- * 0x03 | BMI160_GYRO_RANGE_250_DEG_SEC
- * 0x04 | BMI160_GYRO_RANGE_125_DEG_SEC
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_range(u8 *v_range_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the gyro range */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_GYRO_RANGE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_range_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_RANGE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API set the range
- * of gyro from the register 0x43 bit 0 to 2
- *
- * @param v_range_u8 : The value of gyro range
- * value | range
- * ----------|-------------------------------
- * 0x00 | BMI160_GYRO_RANGE_2000_DEG_SEC
- * 0x01 | BMI160_GYRO_RANGE_1000_DEG_SEC
- * 0x02 | BMI160_GYRO_RANGE_500_DEG_SEC
- * 0x03 | BMI160_GYRO_RANGE_250_DEG_SEC
- * 0x04 | BMI160_GYRO_RANGE_125_DEG_SEC
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_range(u8 v_range_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_range_u8 < C_BMI160_FIVE_U8X) {
- /* write the gyro range value */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_GYRO_RANGE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_RANGE,
- v_range_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_GYRO_RANGE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the
- * output data rate of magnetometer from the register 0x44 bit 0 to 3
- *
- *
- *
- *
- * @param v_output_data_rat_u8e : The value of mag output data rate
- * value | mag output data rate
- * ---------|---------------------------
- * 0x00 |BMI160_MAG_OUTPUT_DATA_RATE_RESERVED
- * 0x01 |BMI160_MAG_OUTPUT_DATA_RATE_0_78HZ
- * 0x02 |BMI160_MAG_OUTPUT_DATA_RATE_1_56HZ
- * 0x03 |BMI160_MAG_OUTPUT_DATA_RATE_3_12HZ
- * 0x04 |BMI160_MAG_OUTPUT_DATA_RATE_6_25HZ
- * 0x05 |BMI160_MAG_OUTPUT_DATA_RATE_12_5HZ
- * 0x06 |BMI160_MAG_OUTPUT_DATA_RATE_25HZ
- * 0x07 |BMI160_MAG_OUTPUT_DATA_RATE_50HZ
- * 0x08 |BMI160_MAG_OUTPUT_DATA_RATE_100HZ
- * 0x09 |BMI160_MAG_OUTPUT_DATA_RATE_200HZ
- * 0x0A |BMI160_MAG_OUTPUT_DATA_RATE_400HZ
- * 0x0B |BMI160_MAG_OUTPUT_DATA_RATE_800HZ
- * 0x0C |BMI160_MAG_OUTPUT_DATA_RATE_1600HZ
- * 0x0D |BMI160_MAG_OUTPUT_DATA_RATE_RESERVED0
- * 0x0E |BMI160_MAG_OUTPUT_DATA_RATE_RESERVED1
- * 0x0F |BMI160_MAG_OUTPUT_DATA_RATE_RESERVED2
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_mag_output_data_rate(
- u8 *v_output_data_rat_u8e)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the mag data output rate*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_MAG_CONFIG_OUTPUT_DATA_RATE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_output_data_rat_u8e = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_CONFIG_OUTPUT_DATA_RATE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set the
- * output data rate of magnetometer from the register 0x44 bit 0 to 3
- *
- *
- *
- *
- * @param v_output_data_rat_u8e : The value of mag output data rate
- * value | mag output data rate
- * ---------|---------------------------
- * 0x00 |BMI160_MAG_OUTPUT_DATA_RATE_RESERVED
- * 0x01 |BMI160_MAG_OUTPUT_DATA_RATE_0_78HZ
- * 0x02 |BMI160_MAG_OUTPUT_DATA_RATE_1_56HZ
- * 0x03 |BMI160_MAG_OUTPUT_DATA_RATE_3_12HZ
- * 0x04 |BMI160_MAG_OUTPUT_DATA_RATE_6_25HZ
- * 0x05 |BMI160_MAG_OUTPUT_DATA_RATE_12_5HZ
- * 0x06 |BMI160_MAG_OUTPUT_DATA_RATE_25HZ
- * 0x07 |BMI160_MAG_OUTPUT_DATA_RATE_50HZ
- * 0x08 |BMI160_MAG_OUTPUT_DATA_RATE_100HZ
- * 0x09 |BMI160_MAG_OUTPUT_DATA_RATE_200HZ
- * 0x0A |BMI160_MAG_OUTPUT_DATA_RATE_400HZ
- * 0x0B |BMI160_MAG_OUTPUT_DATA_RATE_800HZ
- * 0x0C |BMI160_MAG_OUTPUT_DATA_RATE_1600HZ
- * 0x0D |BMI160_MAG_OUTPUT_DATA_RATE_RESERVED0
- * 0x0E |BMI160_MAG_OUTPUT_DATA_RATE_RESERVED1
- * 0x0F |BMI160_MAG_OUTPUT_DATA_RATE_RESERVED2
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_mag_output_data_rate(
- u8 v_output_data_rat_u8e)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* select the mag data output rate*/
- if ((v_output_data_rat_u8e < C_BMI160_THIRTEEN_U8X)
- && (v_output_data_rat_u8e != C_BMI160_ZERO_U8X)
- && (v_output_data_rat_u8e != C_BMI160_FOURTEEN_U8X)
- && (v_output_data_rat_u8e != C_BMI160_FIVETEEN_U8X)) {
- /* write the mag data output rate*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_MAG_CONFIG_OUTPUT_DATA_RATE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_CONFIG_OUTPUT_DATA_RATE,
- v_output_data_rat_u8e);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_MAG_CONFIG_OUTPUT_DATA_RATE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read Down sampling
- * for gyro (2**downs_gyro) in the register 0x45 bit 0 to 2
- *
- *
- *
- *
- * @param v_fifo_down_gyro_u8 :The value of gyro fifo down
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_fifo_down_gyro(
- u8 *v_fifo_down_gyro_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the gyro fifo down*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_DOWN_GYRO__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_fifo_down_gyro_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_DOWN_GYRO);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set Down sampling
- * for gyro (2**downs_gyro) in the register 0x45 bit 0 to 2
- *
- *
- *
- *
- * @param v_fifo_down_gyro_u8 :The value of gyro fifo down
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_fifo_down_gyro(
- u8 v_fifo_down_gyro_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write the gyro fifo down*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_DOWN_GYRO__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(
- v_data_u8,
- BMI160_USER_FIFO_DOWN_GYRO,
- v_fifo_down_gyro_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FIFO_DOWN_GYRO__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read gyro fifo filter data
- * from the register 0x45 bit 3
- *
- *
- *
- * @param v_gyro_fifo_filter_data_u8 :The value of gyro filter data
- * value | gyro_fifo_filter_data
- * ------------|-------------------------
- * 0x00 | Unfiltered data
- * 0x01 | Filtered data
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_fifo_filter_data(
- u8 *v_gyro_fifo_filter_data_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the gyro fifo filter data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_FILTER_GYRO__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_gyro_fifo_filter_data_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_FILTER_GYRO);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set gyro fifo filter data
- * from the register 0x45 bit 3
- *
- *
- *
- * @param v_gyro_fifo_filter_data_u8 :The value of gyro filter data
- * value | gyro_fifo_filter_data
- * ------------|-------------------------
- * 0x00 | Unfiltered data
- * 0x01 | Filtered data
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_fifo_filter_data(
- u8 v_gyro_fifo_filter_data_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_gyro_fifo_filter_data_u8 < C_BMI160_TWO_U8X) {
- /* write the gyro fifo filter data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_FILTER_GYRO__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(
- v_data_u8,
- BMI160_USER_FIFO_FILTER_GYRO,
- v_gyro_fifo_filter_data_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FIFO_FILTER_GYRO__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read Down sampling
- * for accel (2*downs_accel) from the register 0x45 bit 4 to 6
- *
- *
- *
- *
- * @param v_fifo_down_u8 :The value of accel fifo down
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_fifo_down_accel(
- u8 *v_fifo_down_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the accel fifo down data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_DOWN_ACCEL__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_fifo_down_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_DOWN_ACCEL);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set Down sampling
- * for accel (2*downs_accel) from the register 0x45 bit 4 to 6
- *
- *
- *
- *
- * @param v_fifo_down_u8 :The value of accel fifo down
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_fifo_down_accel(
- u8 v_fifo_down_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write the accel fifo down data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_DOWN_ACCEL__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_DOWN_ACCEL, v_fifo_down_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FIFO_DOWN_ACCEL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read accel fifo filter data
- * from the register 0x45 bit 7
- *
- *
- *
- * @param v_accel_fifo_filter_u8 :The value of accel filter data
- * value | accel_fifo_filter_data
- * ------------|-------------------------
- * 0x00 | Unfiltered data
- * 0x01 | Filtered data
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_fifo_filter_data(
- u8 *v_accel_fifo_filter_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the accel fifo filter data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_FILTER_ACCEL__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_accel_fifo_filter_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_FILTER_ACCEL);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set accel fifo filter data
- * from the register 0x45 bit 7
- *
- *
- *
- * @param v_accel_fifo_filter_u8 :The value of accel filter data
- * value | accel_fifo_filter_data
- * ------------|-------------------------
- * 0x00 | Unfiltered data
- * 0x01 | Filtered data
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_fifo_filter_data(
- u8 v_accel_fifo_filter_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_accel_fifo_filter_u8 < C_BMI160_TWO_U8X) {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_FILTER_ACCEL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- /* write accel fifo filter data */
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_FILTER_ACCEL,
- v_accel_fifo_filter_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FIFO_FILTER_ACCEL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to Trigger an interrupt
- * when FIFO contains water mark level from the register 0x46 bit 0 to 7
- *
- *
- *
- * @param v_fifo_wm_u8 : The value of fifo water mark level
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_fifo_wm(
- u8 *v_fifo_wm_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the fifo water mark level*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_WM__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_fifo_wm_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_WM);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to Trigger an interrupt
- * when FIFO contains water mark level from the register 0x46 bit 0 to 7
- *
- *
- *
- * @param v_fifo_wm_u8 : The value of fifo water mark level
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_fifo_wm(
- u8 v_fifo_wm_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write the fifo water mark level*/
- com_rslt =
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_WM__REG,
- &v_fifo_wm_u8, C_BMI160_ONE_U8X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the fifo stop on full in the register 0x47 bit 0
- * @brief It stop writing samples into FIFO when FIFO is full
- *
- *
- *
- * @param v_fifo_stop_on_full_u8 :The value of fifo stop on full
- * value | fifo stop on full
- * ------------|-------------------------
- * 0x00 | do not stop writing to FIFO when full
- * 0x01 | Stop writing into FIFO when full.
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_fifo_stop_on_full(
- u8 *v_fifo_stop_on_full_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the fifo stop on full data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_STOP_ON_FULL__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_fifo_stop_on_full_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_STOP_ON_FULL);
- }
- return com_rslt;
- }
- /*!
- * @brief This API sey the fifo stop on full in the register 0x47 bit 0
- * @brief It stop writing samples into FIFO when FIFO is full
- *
- *
- *
- * @param v_fifo_stop_on_full_u8 :The value of fifo stop on full
- * value | fifo stop on full
- * ------------|-------------------------
- * 0x00 | do not stop writing to FIFO when full
- * 0x01 | Stop writing into FIFO when full.
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_fifo_stop_on_full(
- u8 v_fifo_stop_on_full_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_stop_on_full_u8 < C_BMI160_TWO_U8X) {
- /* write fifo stop on full data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_STOP_ON_FULL__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_STOP_ON_FULL,
- v_fifo_stop_on_full_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_FIFO_STOP_ON_FULL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads fifo sensor time
- * frame after the last valid data frame form the register 0x47 bit 1
- *
- *
- *
- *
- * @param v_fifo_time_enable_u8 : The value of sensor time
- * value | fifo sensor time
- * ------------|-------------------------
- * 0x00 | do not return sensortime frame
- * 0x01 | return sensortime frame
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_fifo_time_enable(
- u8 *v_fifo_time_enable_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the fifo sensor time*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_TIME_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_fifo_time_enable_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_TIME_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API set fifo sensor time
- * frame after the last valid data frame form the register 0x47 bit 1
- *
- *
- *
- *
- * @param v_fifo_time_enable_u8 : The value of sensor time
- * value | fifo sensor time
- * ------------|-------------------------
- * 0x00 | do not return sensortime frame
- * 0x01 | return sensortime frame
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_fifo_time_enable(
- u8 v_fifo_time_enable_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_time_enable_u8 < C_BMI160_TWO_U8X) {
- /* write the fifo sensor time*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_TIME_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_TIME_ENABLE,
- v_fifo_time_enable_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FIFO_TIME_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads FIFO tag interrupt2 enable status
- * from the resister 0x47 bit 2
- *
- * @param v_fifo_tag_intr2_u8 : The value of fifo tag interrupt
- * value | fifo tag interrupt
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_fifo_tag_intr2_enable(
- u8 *v_fifo_tag_intr2_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the fifo tag interrupt2*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_TAG_INTR2_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_fifo_tag_intr2_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_TAG_INTR2_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API set FIFO tag interrupt2 enable status
- * from the resister 0x47 bit 2
- *
- * @param v_fifo_tag_intr2_u8 : The value of fifo tag interrupt
- * value | fifo tag interrupt
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_fifo_tag_intr2_enable(
- u8 v_fifo_tag_intr2_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_tag_intr2_u8 < C_BMI160_TWO_U8X) {
- /* write the fifo tag interrupt2*/
- com_rslt = bmi160_set_input_enable(1,
- v_fifo_tag_intr2_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_TAG_INTR2_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_TAG_INTR2_ENABLE,
- v_fifo_tag_intr2_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FIFO_TAG_INTR2_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API get FIFO tag interrupt1 enable status
- * from the resister 0x47 bit 3
- *
- * @param v_fifo_tag_intr1_u8 :The value of fifo tag interrupt1
- * value | fifo tag interrupt
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_fifo_tag_intr1_enable(
- u8 *v_fifo_tag_intr1_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read fifo tag interrupt*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_TAG_INTR1_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_fifo_tag_intr1_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_TAG_INTR1_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API set FIFO tag interrupt1 enable status
- * from the resister 0x47 bit 3
- *
- * @param v_fifo_tag_intr1_u8 :The value of fifo tag interrupt1
- * value | fifo tag interrupt
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_fifo_tag_intr1_enable(
- u8 v_fifo_tag_intr1_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_tag_intr1_u8 < C_BMI160_TWO_U8X) {
- /* write the fifo tag interrupt*/
- com_rslt = bmi160_set_input_enable(C_BMI160_ZERO_U8X,
- v_fifo_tag_intr1_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_TAG_INTR1_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_TAG_INTR1_ENABLE,
- v_fifo_tag_intr1_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FIFO_TAG_INTR1_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads FIFO frame
- * header enable from the register 0x47 bit 4
- *
- * @param v_fifo_header_u8 :The value of fifo header
- * value | fifo header
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_fifo_header_enable(
- u8 *v_fifo_header_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read fifo header */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_HEADER_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_fifo_header_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_HEADER_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API set FIFO frame
- * header enable from the register 0x47 bit 4
- *
- * @param v_fifo_header_u8 :The value of fifo header
- * value | fifo header
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_fifo_header_enable(
- u8 v_fifo_header_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_header_u8 < C_BMI160_TWO_U8X) {
- /* write the fifo header */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_HEADER_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_HEADER_ENABLE,
- v_fifo_header_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FIFO_HEADER_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read stored
- * magnetometer data in FIFO (all 3 axes) from the register 0x47 bit 5
- *
- * @param v_fifo_mag_u8 : The value of fifo mag enble
- * value | fifo mag
- * ----------|-------------------
- * 0x00 | no magnetometer data is stored
- * 0x01 | magnetometer data is stored
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_fifo_mag_enable(
- u8 *v_fifo_mag_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the fifo mag enable*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_MAG_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_fifo_mag_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_MAG_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set stored
- * magnetometer data in FIFO (all 3 axes) from the register 0x47 bit 5
- *
- * @param v_fifo_mag_u8 : The value of fifo mag enble
- * value | fifo mag
- * ----------|-------------------
- * 0x00 | no magnetometer data is stored
- * 0x01 | magnetometer data is stored
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_fifo_mag_enable(
- u8 v_fifo_mag_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_mag_u8 < C_BMI160_TWO_U8X) {
- /* write the fifo mag enable*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_FIFO_MAG_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_MAG_ENABLE,
- v_fifo_mag_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_FIFO_MAG_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read stored
- * accel data in FIFO (all 3 axes) from the register 0x47 bit 6
- *
- * @param v_fifo_accel_u8 : The value of fifo accel enble
- * value | fifo accel
- * ----------|-------------------
- * 0x00 | no accel data is stored
- * 0x01 | accel data is stored
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_fifo_accel_enable(
- u8 *v_fifo_accel_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the accel fifo enable*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_ACCEL_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_fifo_accel_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_ACCEL_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set stored
- * accel data in FIFO (all 3 axes) from the register 0x47 bit 6
- *
- * @param v_fifo_accel_u8 : The value of fifo accel enble
- * value | fifo accel
- * ----------|-------------------
- * 0x00 | no accel data is stored
- * 0x01 | accel data is stored
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_fifo_accel_enable(
- u8 v_fifo_accel_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_accel_u8 < C_BMI160_TWO_U8X) {
- /* write the fifo mag enables*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_ACCEL_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_ACCEL_ENABLE, v_fifo_accel_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FIFO_ACCEL_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read stored
- * gyro data in FIFO (all 3 axes) from the resister 0x47 bit 7
- *
- *
- * @param v_fifo_gyro_u8 : The value of fifo gyro enble
- * value | fifo gyro
- * ----------|-------------------
- * 0x00 | no gyro data is stored
- * 0x01 | gyro data is stored
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_fifo_gyro_enable(
- u8 *v_fifo_gyro_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read fifo gyro enable */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_GYRO_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_fifo_gyro_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_GYRO_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set stored
- * gyro data in FIFO (all 3 axes) from the resister 0x47 bit 7
- *
- *
- * @param v_fifo_gyro_u8 : The value of fifo gyro enble
- * value | fifo gyro
- * ----------|-------------------
- * 0x00 | no gyro data is stored
- * 0x01 | gyro data is stored
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_fifo_gyro_enable(
- u8 v_fifo_gyro_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_gyro_u8 < C_BMI160_TWO_U8X) {
- /* write fifo gyro enable*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_GYRO_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_GYRO_ENABLE, v_fifo_gyro_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FIFO_GYRO_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * I2C device address of auxiliary mag from the register 0x4B bit 1 to 7
- *
- *
- *
- *
- * @param v_i2c_device_addr_u8 : The value of mag I2C device address
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_i2c_device_addr(
- u8 *v_i2c_device_addr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the mag I2C device address*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_I2C_DEVICE_ADDR__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_i2c_device_addr_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_I2C_DEVICE_ADDR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set
- * I2C device address of auxiliary mag from the register 0x4B bit 1 to 7
- *
- *
- *
- *
- * @param v_i2c_device_addr_u8 : The value of mag I2C device address
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_i2c_device_addr(
- u8 v_i2c_device_addr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write the mag I2C device address*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_I2C_DEVICE_ADDR__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_I2C_DEVICE_ADDR,
- v_i2c_device_addr_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_I2C_DEVICE_ADDR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * Burst data length (1,2,6,8 byte) from the register 0x4C bit 0 to 1
- *
- *
- *
- *
- * @param v_mag_burst_u8 : The data of mag burst read lenth
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_mag_burst(
- u8 *v_mag_burst_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read mag burst mode length*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_MAG_BURST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_mag_burst_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_BURST);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set
- * Burst data length (1,2,6,8 byte) from the register 0x4C bit 0 to 1
- *
- *
- *
- *
- * @param v_mag_burst_u8 : The data of mag burst read lenth
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_mag_burst(
- u8 v_mag_burst_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write mag burst mode length*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_MAG_BURST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_BURST, v_mag_burst_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_MAG_BURST__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * trigger-readout offset in units of 2.5 ms. If set to zero,
- * the offset is maximum, i.e. after readout a trigger
- * is issued immediately. from the register 0x4C bit 2 to 5
- *
- *
- *
- *
- * @param v_mag_offset_u8 : The value of mag offset
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_mag_offset(
- u8 *v_mag_offset_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_MAG_OFFSET__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_mag_offset_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_OFFSET);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set
- * trigger-readout offset in units of 2.5 ms. If set to zero,
- * the offset is maximum, i.e. after readout a trigger
- * is issued immediately. from the register 0x4C bit 2 to 5
- *
- *
- *
- *
- * @param v_mag_offset_u8 : The value of mag offset
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_mag_offset(
- u8 v_mag_offset_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_MAG_OFFSET__REG, &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_OFFSET, v_mag_offset_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->dev_addr,
- BMI160_USER_MAG_OFFSET__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * Enable register access on MAG_IF[2] or MAG_IF[3] writes.
- * This implies that the DATA registers are not updated with
- * magnetometer values. Accessing magnetometer requires
- * the magnetometer in normal mode in PMU_STATUS.
- * from the register 0x4C bit 7
- *
- *
- *
- * @param v_mag_manual_u8 : The value of mag manual enable
- * value | mag manual
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_mag_manual_enable(
- u8 *v_mag_manual_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read mag manual */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_MAG_MANUAL_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_mag_manual_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_MANUAL_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set
- * Enable register access on MAG_IF[2] or MAG_IF[3] writes.
- * This implies that the DATA registers are not updated with
- * magnetometer values. Accessing magnetometer requires
- * the magnetometer in normal mode in PMU_STATUS.
- * from the register 0x4C bit 7
- *
- *
- *
- * @param v_mag_manual_u8 : The value of mag manual enable
- * value | mag manual
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_mag_manual_enable(
- u8 v_mag_manual_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write the mag manual*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_MAG_MANUAL_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- /* set the bit of mag manual enable*/
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_MANUAL_ENABLE, v_mag_manual_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->dev_addr,
- BMI160_USER_MAG_MANUAL_ENABLE__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- }
- if (com_rslt == SUCCESS)
- p_bmi160->mag_manual_enable = v_mag_manual_u8;
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read data
- * magnetometer address to read from the register 0x4D bit 0 to 7
- * @brief It used to provide mag read address of auxiliary mag
- *
- *
- *
- *
- * @param v_mag_read_addr_u8 : The value of address need to be read
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_mag_read_addr(
- u8 *v_mag_read_addr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the written address*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_READ_ADDR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_mag_read_addr_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_READ_ADDR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set
- * magnetometer write address from the register 0x4D bit 0 to 7
- * @brief mag write address writes the address of auxiliary mag to write
- *
- *
- *
- * @param v_mag_read_addr_u8:
- * The data of auxiliary mag address to write data
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_mag_read_addr(
- u8 v_mag_read_addr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write the mag read address*/
- com_rslt =
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->dev_addr,
- BMI160_USER_READ_ADDR__REG, &v_mag_read_addr_u8,
- C_BMI160_ONE_U8X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * magnetometer write address from the register 0x4E bit 0 to 7
- * @brief mag write address writes the address of auxiliary mag to write
- *
- *
- *
- * @param v_mag_write_addr_u8:
- * The data of auxiliary mag address to write data
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_mag_write_addr(
- u8 *v_mag_write_addr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the address of last written */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_WRITE_ADDR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_mag_write_addr_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_WRITE_ADDR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set
- * magnetometer write address from the register 0x4E bit 0 to 7
- * @brief mag write address writes the address of auxiliary mag to write
- *
- *
- *
- * @param v_mag_write_addr_u8:
- * The data of auxiliary mag address to write data
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_mag_write_addr(
- u8 v_mag_write_addr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write the data of mag address to write data */
- com_rslt =
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->dev_addr,
- BMI160_USER_WRITE_ADDR__REG, &v_mag_write_addr_u8,
- C_BMI160_ONE_U8X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read magnetometer write data
- * form the resister 0x4F bit 0 to 7
- * @brief This writes the data will be wrote to mag
- *
- *
- *
- * @param v_mag_write_data_u8: The value of mag data
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_mag_write_data(
- u8 *v_mag_write_data_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_WRITE_DATA__REG, &v_data_u8,
- C_BMI160_ONE_U8X);
- *v_mag_write_data_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_WRITE_DATA);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set magnetometer write data
- * form the resister 0x4F bit 0 to 7
- * @brief This writes the data will be wrote to mag
- *
- *
- *
- * @param v_mag_write_data_u8: The value of mag data
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_mag_write_data(
- u8 v_mag_write_data_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt =
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->dev_addr,
- BMI160_USER_WRITE_DATA__REG, &v_mag_write_data_u8,
- C_BMI160_ONE_U8X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * interrupt enable from the register 0x50 bit 0 to 7
- *
- *
- *
- *
- * @param v_enable_u8 : Value to decided to select interrupt
- * v_enable_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_ANY_MOTION_X_ENABLE
- * 1 | BMI160_ANY_MOTION_Y_ENABLE
- * 2 | BMI160_ANY_MOTION_Z_ENABLE
- * 3 | BMI160_DOUBLE_TAP_ENABLE
- * 4 | BMI160_SINGLE_TAP_ENABLE
- * 5 | BMI160_ORIENT_ENABLE
- * 6 | BMI160_FLAT_ENABLE
- *
- * @param v_intr_enable_zero_u8 : The interrupt enable value
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_enable_0(
- u8 v_enable_u8, u8 *v_intr_enable_zero_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* select interrupt to read*/
- switch (v_enable_u8) {
- case BMI160_ANY_MOTION_X_ENABLE:
- /* read the any motion interrupt x data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_0_ANY_MOTION_X_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_zero_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_ANY_MOTION_X_ENABLE);
- break;
- case BMI160_ANY_MOTION_Y_ENABLE:
- /* read the any motion interrupt y data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_0_ANY_MOTION_Y_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_zero_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_ANY_MOTION_Y_ENABLE);
- break;
- case BMI160_ANY_MOTION_Z_ENABLE:
- /* read the any motion interrupt z data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_0_ANY_MOTION_Z_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_zero_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_ANY_MOTION_Z_ENABLE);
- break;
- case BMI160_DOUBLE_TAP_ENABLE:
- /* read the double tap interrupt data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_0_DOUBLE_TAP_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_zero_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_DOUBLE_TAP_ENABLE);
- break;
- case BMI160_SINGLE_TAP_ENABLE:
- /* read the single tap interrupt data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_0_SINGLE_TAP_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_zero_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_SINGLE_TAP_ENABLE);
- break;
- case BMI160_ORIENT_ENABLE:
- /* read the orient interrupt data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_ENABLE_0_ORIENT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_zero_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_ORIENT_ENABLE);
- break;
- case BMI160_FLAT_ENABLE:
- /* read the flat interrupt data */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_ENABLE_0_FLAT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_zero_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_FLAT_ENABLE);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set
- * interrupt enable from the register 0x50 bit 0 to 7
- *
- *
- *
- *
- * @param v_enable_u8 : Value to decided to select interrupt
- * v_enable_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_ANY_MOTION_X_ENABLE
- * 1 | BMI160_ANY_MOTION_Y_ENABLE
- * 2 | BMI160_ANY_MOTION_Z_ENABLE
- * 3 | BMI160_DOUBLE_TAP_ENABLE
- * 4 | BMI160_SINGLE_TAP_ENABLE
- * 5 | BMI160_ORIENT_ENABLE
- * 6 | BMI160_FLAT_ENABLE
- *
- * @param v_intr_enable_zero_u8 : The interrupt enable value
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_enable_0(
- u8 v_enable_u8, u8 v_intr_enable_zero_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_enable_u8) {
- case BMI160_ANY_MOTION_X_ENABLE:
- /* write any motion x*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_ENABLE_0_ANY_MOTION_X_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_ANY_MOTION_X_ENABLE,
- v_intr_enable_zero_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_0_ANY_MOTION_X_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_ANY_MOTION_Y_ENABLE:
- /* write any motion y*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_ENABLE_0_ANY_MOTION_Y_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_ANY_MOTION_Y_ENABLE,
- v_intr_enable_zero_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_0_ANY_MOTION_Y_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_ANY_MOTION_Z_ENABLE:
- /* write any motion z*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_ENABLE_0_ANY_MOTION_Z_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_ANY_MOTION_Z_ENABLE,
- v_intr_enable_zero_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_0_ANY_MOTION_Z_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_DOUBLE_TAP_ENABLE:
- /* write double tap*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_ENABLE_0_DOUBLE_TAP_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_DOUBLE_TAP_ENABLE,
- v_intr_enable_zero_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_0_DOUBLE_TAP_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_SINGLE_TAP_ENABLE:
- /* write single tap */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_ENABLE_0_SINGLE_TAP_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_SINGLE_TAP_ENABLE,
- v_intr_enable_zero_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_0_SINGLE_TAP_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_ORIENT_ENABLE:
- /* write orient interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_ENABLE_0_ORIENT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_ORIENT_ENABLE,
- v_intr_enable_zero_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_0_ORIENT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_FLAT_ENABLE:
- /* write flat interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_ENABLE_0_FLAT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_0_FLAT_ENABLE,
- v_intr_enable_zero_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_0_FLAT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * interrupt enable byte1 from the register 0x51 bit 0 to 6
- * @brief It read the high_g_x,high_g_y,high_g_z,low_g_enable
- * data ready, fifo full and fifo water mark.
- *
- *
- *
- * @param v_enable_u8 : The value of interrupt enable
- * @param v_enable_u8 : Value to decided to select interrupt
- * v_enable_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_HIGH_G_X_ENABLE
- * 1 | BMI160_HIGH_G_Y_ENABLE
- * 2 | BMI160_HIGH_G_Z_ENABLE
- * 3 | BMI160_LOW_G_ENABLE
- * 4 | BMI160_DATA_RDY_ENABLE
- * 5 | BMI160_FIFO_FULL_ENABLE
- * 6 | BMI160_FIFO_WM_ENABLE
- *
- * @param v_intr_enable_1_u8 : The interrupt enable value
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_enable_1(
- u8 v_enable_u8, u8 *v_intr_enable_1_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_enable_u8) {
- case BMI160_HIGH_G_X_ENABLE:
- /* read high_g_x interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_X_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_1_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_X_ENABLE);
- break;
- case BMI160_HIGH_G_Y_ENABLE:
- /* read high_g_y interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_Y_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_1_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_Y_ENABLE);
- break;
- case BMI160_HIGH_G_Z_ENABLE:
- /* read high_g_z interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_Z_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_1_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_Z_ENABLE);
- break;
- case BMI160_LOW_G_ENABLE:
- /* read low_g interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_ENABLE_1_LOW_G_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_1_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_LOW_G_ENABLE);
- break;
- case BMI160_DATA_RDY_ENABLE:
- /* read data ready interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_DATA_RDY_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_1_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_DATA_RDY_ENABLE);
- break;
- case BMI160_FIFO_FULL_ENABLE:
- /* read fifo full interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_FIFO_FULL_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_1_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_FIFO_FULL_ENABLE);
- break;
- case BMI160_FIFO_WM_ENABLE:
- /* read fifo water mark interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_FIFO_WM_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_1_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_FIFO_WM_ENABLE);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set
- * interrupt enable byte1 from the register 0x51 bit 0 to 6
- * @brief It read the high_g_x,high_g_y,high_g_z,low_g_enable
- * data ready, fifo full and fifo water mark.
- *
- *
- *
- * @param v_enable_u8 : The value of interrupt enable
- * @param v_enable_u8 : Value to decided to select interrupt
- * v_enable_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_HIGH_G_X_ENABLE
- * 1 | BMI160_HIGH_G_Y_ENABLE
- * 2 | BMI160_HIGH_G_Z_ENABLE
- * 3 | BMI160_LOW_G_ENABLE
- * 4 | BMI160_DATA_RDY_ENABLE
- * 5 | BMI160_FIFO_FULL_ENABLE
- * 6 | BMI160_FIFO_WM_ENABLE
- *
- * @param v_intr_enable_1_u8 : The interrupt enable value
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_enable_1(
- u8 v_enable_u8, u8 v_intr_enable_1_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_enable_u8) {
- case BMI160_HIGH_G_X_ENABLE:
- /* write high_g_x interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_X_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_X_ENABLE,
- v_intr_enable_1_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_X_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_HIGH_G_Y_ENABLE:
- /* write high_g_y interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_Y_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_Y_ENABLE,
- v_intr_enable_1_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_Y_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_HIGH_G_Z_ENABLE:
- /* write high_g_z interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_Z_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_Z_ENABLE,
- v_intr_enable_1_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_HIGH_G_Z_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_LOW_G_ENABLE:
- /* write low_g interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_LOW_G_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_LOW_G_ENABLE,
- v_intr_enable_1_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_LOW_G_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_DATA_RDY_ENABLE:
- /* write data ready interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_DATA_RDY_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_DATA_RDY_ENABLE,
- v_intr_enable_1_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_DATA_RDY_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_FIFO_FULL_ENABLE:
- /* write fifo full interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_FIFO_FULL_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_FIFO_FULL_ENABLE,
- v_intr_enable_1_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_FIFO_FULL_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_FIFO_WM_ENABLE:
- /* write fifo water mark interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_ENABLE_1_FIFO_WM_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_1_FIFO_WM_ENABLE,
- v_intr_enable_1_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_1_FIFO_WM_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * interrupt enable byte2 from the register bit 0x52 bit 0 to 3
- * @brief It reads no motion x,y and z
- *
- *
- *
- * @param v_enable_u8: The value of interrupt enable
- * v_enable_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_NOMOTION_X_ENABLE
- * 1 | BMI160_NOMOTION_Y_ENABLE
- * 2 | BMI160_NOMOTION_Z_ENABLE
- *
- * @param v_intr_enable_2_u8 : The interrupt enable value
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_enable_2(
- u8 v_enable_u8, u8 *v_intr_enable_2_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_enable_u8) {
- case BMI160_NOMOTION_X_ENABLE:
- /* read no motion x */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_X_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_2_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_X_ENABLE);
- break;
- case BMI160_NOMOTION_Y_ENABLE:
- /* read no motion y */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_Y_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_2_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_Y_ENABLE);
- break;
- case BMI160_NOMOTION_Z_ENABLE:
- /* read no motion z */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_Z_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_enable_2_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_Z_ENABLE);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set
- * interrupt enable byte2 from the register bit 0x52 bit 0 to 3
- * @brief It reads no motion x,y and z
- *
- *
- *
- * @param v_enable_u8: The value of interrupt enable
- * v_enable_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_NOMOTION_X_ENABLE
- * 1 | BMI160_NOMOTION_Y_ENABLE
- * 2 | BMI160_NOMOTION_Z_ENABLE
- *
- * @param v_intr_enable_2_u8 : The interrupt enable value
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_enable_2(
- u8 v_enable_u8, u8 v_intr_enable_2_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_enable_u8) {
- case BMI160_NOMOTION_X_ENABLE:
- /* write no motion x */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_X_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_X_ENABLE,
- v_intr_enable_2_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_X_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_NOMOTION_Y_ENABLE:
- /* write no motion y */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_Y_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_Y_ENABLE,
- v_intr_enable_2_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_Y_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_NOMOTION_Z_ENABLE:
- /* write no motion z */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_Z_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_Z_ENABLE,
- v_intr_enable_2_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_2_NOMOTION_Z_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * interrupt enable step detector interrupt from
- * the register bit 0x52 bit 3
- *
- *
- *
- *
- * @param v_step_intr_u8 : The value of step detector interrupt enable
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_step_detector_enable(
- u8 *v_step_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the step detector interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_2_STEP_DETECTOR_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_step_intr_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_2_STEP_DETECTOR_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set
- * interrupt enable step detector interrupt from
- * the register bit 0x52 bit 3
- *
- *
- *
- *
- * @param v_step_intr_u8 : The value of step detector interrupt enable
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_step_detector_enable(
- u8 v_step_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_2_STEP_DETECTOR_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ENABLE_2_STEP_DETECTOR_ENABLE,
- v_step_intr_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_ENABLE_2_STEP_DETECTOR_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Configure trigger condition of interrupt1
- * and interrupt2 pin from the register 0x53
- * @brief interrupt1 - bit 0
- * @brief interrupt2 - bit 4
- *
- * @param v_channel_u8: The value of edge trigger selection
- * v_channel_u8 | Edge trigger
- * ---------------|---------------
- * 0 | BMI160_INTR1_EDGE_CTRL
- * 1 | BMI160_INTR2_EDGE_CTRL
- *
- * @param v_intr_edge_ctrl_u8 : The value of edge trigger enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_EDGE
- * 0x00 | BMI160_LEVEL
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_edge_ctrl(
- u8 v_channel_u8, u8 *v_intr_edge_ctrl_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- case BMI160_INTR1_EDGE_CTRL:
- /* read the edge trigger interrupt1*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_EDGE_CTRL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_edge_ctrl_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR1_EDGE_CTRL);
- break;
- case BMI160_INTR2_EDGE_CTRL:
- /* read the edge trigger interrupt2*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_EDGE_CTRL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_edge_ctrl_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR2_EDGE_CTRL);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Configure trigger condition of interrupt1
- * and interrupt2 pin from the register 0x53
- * @brief interrupt1 - bit 0
- * @brief interrupt2 - bit 4
- *
- * @param v_channel_u8: The value of edge trigger selection
- * v_channel_u8 | Edge trigger
- * ---------------|---------------
- * 0 | BMI160_INTR1_EDGE_CTRL
- * 1 | BMI160_INTR2_EDGE_CTRL
- *
- * @param v_intr_edge_ctrl_u8 : The value of edge trigger enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_EDGE
- * 0x00 | BMI160_LEVEL
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_edge_ctrl(
- u8 v_channel_u8, u8 v_intr_edge_ctrl_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- case BMI160_INTR1_EDGE_CTRL:
- /* write the edge trigger interrupt1*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_EDGE_CTRL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR1_EDGE_CTRL,
- v_intr_edge_ctrl_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_EDGE_CTRL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_EDGE_CTRL:
- /* write the edge trigger interrupt2*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_EDGE_CTRL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR2_EDGE_CTRL,
- v_intr_edge_ctrl_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_EDGE_CTRL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief API used for get the Configure level condition of interrupt1
- * and interrupt2 pin form the register 0x53
- * @brief interrupt1 - bit 1
- * @brief interrupt2 - bit 5
- *
- * @param v_channel_u8: The value of level condition selection
- * v_channel_u8 | level selection
- * ---------------|---------------
- * 0 | BMI160_INTR1_LEVEL
- * 1 | BMI160_INTR2_LEVEL
- *
- * @param v_intr_level_u8 : The value of level of interrupt enable
- * value | Behaviour
- * ----------|-------------------
- * 0x01 | BMI160_LEVEL_HIGH
- * 0x00 | BMI160_LEVEL_LOW
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_level(
- u8 v_channel_u8, u8 *v_intr_level_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- case BMI160_INTR1_LEVEL:
- /* read the interrupt1 level*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_LEVEL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_level_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR1_LEVEL);
- break;
- case BMI160_INTR2_LEVEL:
- /* read the interrupt2 level*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_LEVEL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_level_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR2_LEVEL);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief API used for set the Configure level condition of interrupt1
- * and interrupt2 pin form the register 0x53
- * @brief interrupt1 - bit 1
- * @brief interrupt2 - bit 5
- *
- * @param v_channel_u8: The value of level condition selection
- * v_channel_u8 | level selection
- * ---------------|---------------
- * 0 | BMI160_INTR1_LEVEL
- * 1 | BMI160_INTR2_LEVEL
- *
- * @param v_intr_level_u8 : The value of level of interrupt enable
- * value | Behaviour
- * ----------|-------------------
- * 0x01 | BMI160_LEVEL_HIGH
- * 0x00 | BMI160_LEVEL_LOW
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_level(
- u8 v_channel_u8, u8 v_intr_level_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- case BMI160_INTR1_LEVEL:
- /* write the interrupt1 level*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_LEVEL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR1_LEVEL, v_intr_level_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_LEVEL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_LEVEL:
- /* write the interrupt2 level*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_LEVEL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR2_LEVEL, v_intr_level_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_LEVEL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief API used to get configured output enable of interrupt1
- * and interrupt2 from the register 0x53
- * @brief interrupt1 - bit 2
- * @brief interrupt2 - bit 6
- *
- *
- * @param v_channel_u8: The value of output type enable selection
- * v_channel_u8 | level selection
- * ---------------|---------------
- * 0 | BMI160_INTR1_OUTPUT_TYPE
- * 1 | BMI160_INTR2_OUTPUT_TYPE
- *
- * @param v_intr_output_type_u8 :
- * The value of output type of interrupt enable
- * value | Behaviour
- * ----------|-------------------
- * 0x01 | BMI160_OPEN_DRAIN
- * 0x00 | BMI160_PUSH_PULL
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_output_type(
- u8 v_channel_u8, u8 *v_intr_output_type_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- case BMI160_INTR1_OUTPUT_TYPE:
- /* read the output type of interrupt1*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_OUTPUT_TYPE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_output_type_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR1_OUTPUT_TYPE);
- break;
- case BMI160_INTR2_OUTPUT_TYPE:
- /* read the output type of interrupt2*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_OUTPUT_TYPE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_output_type_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR2_OUTPUT_TYPE);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief API used to set output enable of interrupt1
- * and interrupt2 from the register 0x53
- * @brief interrupt1 - bit 2
- * @brief interrupt2 - bit 6
- *
- *
- * @param v_channel_u8: The value of output type enable selection
- * v_channel_u8 | level selection
- * ---------------|---------------
- * 0 | BMI160_INTR1_OUTPUT_TYPE
- * 1 | BMI160_INTR2_OUTPUT_TYPE
- *
- * @param v_intr_output_type_u8 :
- * The value of output type of interrupt enable
- * value | Behaviour
- * ----------|-------------------
- * 0x01 | BMI160_OPEN_DRAIN
- * 0x00 | BMI160_PUSH_PULL
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_output_type(
- u8 v_channel_u8, u8 v_intr_output_type_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- case BMI160_INTR1_OUTPUT_TYPE:
- /* write the output type of interrupt1*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_OUTPUT_TYPE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR1_OUTPUT_TYPE,
- v_intr_output_type_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_OUTPUT_TYPE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_OUTPUT_TYPE:
- /* write the output type of interrupt2*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_OUTPUT_TYPE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR2_OUTPUT_TYPE,
- v_intr_output_type_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_OUTPUT_TYPE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief API used to get the Output enable for interrupt1
- * and interrupt1 pin from the register 0x53
- * @brief interrupt1 - bit 3
- * @brief interrupt2 - bit 7
- *
- * @param v_channel_u8: The value of output enable selection
- * v_channel_u8 | level selection
- * ---------------|---------------
- * 0 | BMI160_INTR1_OUTPUT_TYPE
- * 1 | BMI160_INTR2_OUTPUT_TYPE
- *
- * @param v_output_enable_u8 :
- * The value of output enable of interrupt enable
- * value | Behaviour
- * ----------|-------------------
- * 0x01 | BMI160_INPUT
- * 0x00 | BMI160_OUTPUT
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_output_enable(
- u8 v_channel_u8, u8 *v_output_enable_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- case BMI160_INTR1_OUTPUT_ENABLE:
- /* read the output enable of interrupt1*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_OUTPUT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_output_enable_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR1_OUTPUT_ENABLE);
- break;
- case BMI160_INTR2_OUTPUT_ENABLE:
- /* read the output enable of interrupt2*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_OUTPUT_EN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_output_enable_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR2_OUTPUT_EN);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief API used to set the Output enable for interrupt1
- * and interrupt1 pin from the register 0x53
- * @brief interrupt1 - bit 3
- * @brief interrupt2 - bit 7
- *
- * @param v_channel_u8: The value of output enable selection
- * v_channel_u8 | level selection
- * ---------------|---------------
- * 0 | BMI160_INTR1_OUTPUT_TYPE
- * 1 | BMI160_INTR2_OUTPUT_TYPE
- *
- * @param v_output_enable_u8 :
- * The value of output enable of interrupt enable
- * value | Behaviour
- * ----------|-------------------
- * 0x01 | BMI160_INPUT
- * 0x00 | BMI160_OUTPUT
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_output_enable(
- u8 v_channel_u8, u8 v_output_enable_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- case BMI160_INTR1_OUTPUT_ENABLE:
- /* write the output enable of interrupt1*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_OUTPUT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR1_OUTPUT_ENABLE,
- v_output_enable_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_OUTPUT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_OUTPUT_ENABLE:
- /* write the output enable of interrupt2*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_OUTPUT_EN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR2_OUTPUT_EN,
- v_output_enable_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_OUTPUT_EN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the latch duration
- * from the register 0x54 bit 0 to 3
- * @brief This latch selection is not applicable for data ready,
- * orientation and flat interrupts.
- *
- *
- *
- * @param v_latch_intr_u8 : The value of latch duration
- * Latch Duration | value
- * --------------------------------------|------------------
- * BMI160_LATCH_DUR_NONE | 0x00
- * BMI160_LATCH_DUR_312_5_MICRO_SEC | 0x01
- * BMI160_LATCH_DUR_625_MICRO_SEC | 0x02
- * BMI160_LATCH_DUR_1_25_MILLI_SEC | 0x03
- * BMI160_LATCH_DUR_2_5_MILLI_SEC | 0x04
- * BMI160_LATCH_DUR_5_MILLI_SEC | 0x05
- * BMI160_LATCH_DUR_10_MILLI_SEC | 0x06
- * BMI160_LATCH_DUR_20_MILLI_SEC | 0x07
- * BMI160_LATCH_DUR_40_MILLI_SEC | 0x08
- * BMI160_LATCH_DUR_80_MILLI_SEC | 0x09
- * BMI160_LATCH_DUR_160_MILLI_SEC | 0x0A
- * BMI160_LATCH_DUR_320_MILLI_SEC | 0x0B
- * BMI160_LATCH_DUR_640_MILLI_SEC | 0x0C
- * BMI160_LATCH_DUR_1_28_SEC | 0x0D
- * BMI160_LATCH_DUR_2_56_SEC | 0x0E
- * BMI160_LATCHED | 0x0F
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_latch_intr(
- u8 *v_latch_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the latch duration value */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_LATCH__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_latch_intr_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_LATCH);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set the latch duration
- * from the register 0x54 bit 0 to 3
- * @brief This latch selection is not applicable for data ready,
- * orientation and flat interrupts.
- *
- *
- *
- * @param v_latch_intr_u8 : The value of latch duration
- * Latch Duration | value
- * --------------------------------------|------------------
- * BMI160_LATCH_DUR_NONE | 0x00
- * BMI160_LATCH_DUR_312_5_MICRO_SEC | 0x01
- * BMI160_LATCH_DUR_625_MICRO_SEC | 0x02
- * BMI160_LATCH_DUR_1_25_MILLI_SEC | 0x03
- * BMI160_LATCH_DUR_2_5_MILLI_SEC | 0x04
- * BMI160_LATCH_DUR_5_MILLI_SEC | 0x05
- * BMI160_LATCH_DUR_10_MILLI_SEC | 0x06
- * BMI160_LATCH_DUR_20_MILLI_SEC | 0x07
- * BMI160_LATCH_DUR_40_MILLI_SEC | 0x08
- * BMI160_LATCH_DUR_80_MILLI_SEC | 0x09
- * BMI160_LATCH_DUR_160_MILLI_SEC | 0x0A
- * BMI160_LATCH_DUR_320_MILLI_SEC | 0x0B
- * BMI160_LATCH_DUR_640_MILLI_SEC | 0x0C
- * BMI160_LATCH_DUR_1_28_SEC | 0x0D
- * BMI160_LATCH_DUR_2_56_SEC | 0x0E
- * BMI160_LATCHED | 0x0F
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_latch_intr(u8 v_latch_intr_u8)
- {
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_latch_intr_u8 < C_BMI160_SIXTEEN_U8X) {
- /* write the latch duration value */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_LATCH__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_LATCH, v_latch_intr_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_LATCH__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief API used to get input enable for interrupt1
- * and interrupt2 pin from the register 0x54
- * @brief interrupt1 - bit 4
- * @brief interrupt2 - bit 5
- *
- * @param v_channel_u8: The value of input enable selection
- * v_channel_u8 | input selection
- * ---------------|---------------
- * 0 | BMI160_INTR1_INPUT_ENABLE
- * 1 | BMI160_INTR2_INPUT_ENABLE
- *
- * @param v_input_en_u8 :
- * The value of input enable of interrupt enable
- * value | Behaviour
- * ----------|-------------------
- * 0x01 | BMI160_INPUT
- * 0x00 | BMI160_OUTPUT
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_input_enable(
- u8 v_channel_u8, u8 *v_input_en_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* read input enable of interrup1 and interrupt2*/
- case BMI160_INTR1_INPUT_ENABLE:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_INPUT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_input_en_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR1_INPUT_ENABLE);
- break;
- case BMI160_INTR2_INPUT_ENABLE:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_INPUT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_input_en_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR2_INPUT_ENABLE);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief API used to set input enable for interrupt1
- * and interrupt2 pin from the register 0x54
- * @brief interrupt1 - bit 4
- * @brief interrupt2 - bit 5
- *
- * @param v_channel_u8: The value of input enable selection
- * v_channel_u8 | input selection
- * ---------------|---------------
- * 0 | BMI160_INTR1_INPUT_ENABLE
- * 1 | BMI160_INTR2_INPUT_ENABLE
- *
- * @param v_input_en_u8 :
- * The value of input enable of interrupt enable
- * value | Behaviour
- * ----------|-------------------
- * 0x01 | BMI160_INPUT
- * 0x00 | BMI160_OUTPUT
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_input_enable(
- u8 v_channel_u8, u8 v_input_en_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* write input enable of interrup1 and interrupt2*/
- case BMI160_INTR1_INPUT_ENABLE:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_INPUT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR1_INPUT_ENABLE, v_input_en_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR1_INPUT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_INPUT_ENABLE:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_INPUT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR2_INPUT_ENABLE, v_input_en_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR2_INPUT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief reads the Low g interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 0 in the register 0x55
- * @brief interrupt2 bit 0 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of low_g selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_LOW_G
- * 1 | BMI160_INTR2_MAP_LOW_G
- *
- * @param v_intr_low_g_u8 : The value of low_g enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_low_g(
- u8 v_channel_u8, u8 *v_intr_low_g_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* read the low_g interrupt */
- case BMI160_INTR1_MAP_LOW_G:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_LOW_G__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_low_g_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_LOW_G);
- break;
- case BMI160_INTR2_MAP_LOW_G:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_LOW_G__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_low_g_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_LOW_G);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief set the Low g interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 0 in the register 0x55
- * @brief interrupt2 bit 0 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of low_g selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_LOW_G
- * 1 | BMI160_INTR2_MAP_LOW_G
- *
- * @param v_intr_low_g_u8 : The value of low_g enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_low_g(
- u8 v_channel_u8, u8 v_intr_low_g_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- u8 v_step_cnt_stat_u8 = C_BMI160_ZERO_U8X;
- u8 v_step_det_stat_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* check the step detector interrupt enable status*/
- com_rslt = bmi160_get_step_detector_enable(&v_step_det_stat_u8);
- /* disable the step detector interrupt */
- if (v_step_det_stat_u8 != C_BMI160_ZERO_U8X)
- com_rslt += bmi160_set_step_detector_enable(C_BMI160_ZERO_U8X);
- /* check the step counter interrupt enable status*/
- com_rslt += bmi160_get_step_counter_enable(&v_step_cnt_stat_u8);
- /* disable the step counter interrupt */
- if (v_step_cnt_stat_u8 != C_BMI160_ZERO_U8X)
- com_rslt += bmi160_set_step_counter_enable(
- C_BMI160_ZERO_U8X);
- switch (v_channel_u8) {
- /* write the low_g interrupt*/
- case BMI160_INTR1_MAP_LOW_G:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_LOW_G__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_LOW_G, v_intr_low_g_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_LOW_G__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_MAP_LOW_G:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_LOW_G__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_LOW_G, v_intr_low_g_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_LOW_G__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Reads the HIGH g interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 1 in the register 0x55
- * @brief interrupt2 bit 1 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of high_g selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_HIGH_G
- * 1 | BMI160_INTR2_MAP_HIGH_G
- *
- * @param v_intr_high_g_u8 : The value of high_g enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_high_g(
- u8 v_channel_u8, u8 *v_intr_high_g_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the high_g interrupt*/
- switch (v_channel_u8) {
- case BMI160_INTR1_MAP_HIGH_G:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_HIGH_G__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_high_g_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_HIGH_G);
- break;
- case BMI160_INTR2_MAP_HIGH_G:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_HIGH_G__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_high_g_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_HIGH_G);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Write the HIGH g interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 1 in the register 0x55
- * @brief interrupt2 bit 1 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of high_g selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_HIGH_G
- * 1 | BMI160_INTR2_MAP_HIGH_G
- *
- * @param v_intr_high_g_u8 : The value of high_g enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_high_g(
- u8 v_channel_u8, u8 v_intr_high_g_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* write the high_g interrupt*/
- case BMI160_INTR1_MAP_HIGH_G:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_HIGH_G__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_HIGH_G, v_intr_high_g_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_HIGH_G__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_MAP_HIGH_G:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_HIGH_G__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_HIGH_G, v_intr_high_g_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_HIGH_G__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Reads the Any motion interrupt
- * interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 2 in the register 0x55
- * @brief interrupt2 bit 2 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of any motion selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_ANY_MOTION
- * 1 | BMI160_INTR2_MAP_ANY_MOTION
- *
- * @param v_intr_any_motion_u8 : The value of any motion enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_any_motion(
- u8 v_channel_u8, u8 *v_intr_any_motion_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* read the any motion interrupt */
- case BMI160_INTR1_MAP_ANY_MOTION:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_ANY_MOTION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_any_motion_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_ANY_MOTION);
- break;
- case BMI160_INTR2_MAP_ANY_MOTION:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_ANY_MOTION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_any_motion_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_ANY_MOTION);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Write the Any motion interrupt
- * interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 2 in the register 0x55
- * @brief interrupt2 bit 2 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of any motion selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_ANY_MOTION
- * 1 | BMI160_INTR2_MAP_ANY_MOTION
- *
- * @param v_intr_any_motion_u8 : The value of any motion enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_any_motion(
- u8 v_channel_u8, u8 v_intr_any_motion_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- u8 sig_mot_stat = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the status of significant motion interrupt */
- com_rslt = bmi160_get_intr_significant_motion_select(&sig_mot_stat);
- /* disable the significant motion interrupt */
- if (sig_mot_stat != C_BMI160_ZERO_U8X)
- com_rslt += bmi160_set_intr_significant_motion_select(
- C_BMI160_ZERO_U8X);
- switch (v_channel_u8) {
- /* write the any motion interrupt */
- case BMI160_INTR1_MAP_ANY_MOTION:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_ANY_MOTION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_ANY_MOTION,
- v_intr_any_motion_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_ANY_MOTION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_MAP_ANY_MOTION:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_ANY_MOTION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_ANY_MOTION,
- v_intr_any_motion_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_ANY_MOTION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Reads the No motion interrupt
- * interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 3 in the register 0x55
- * @brief interrupt2 bit 3 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of no motion selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_NOMO
- * 1 | BMI160_INTR2_MAP_NOMO
- *
- * @param v_intr_nomotion_u8 : The value of no motion enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_nomotion(
- u8 v_channel_u8, u8 *v_intr_nomotion_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* read the no motion interrupt*/
- case BMI160_INTR1_MAP_NOMO:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_NOMOTION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_nomotion_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_NOMOTION);
- break;
- case BMI160_INTR2_MAP_NOMO:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_NOMOTION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_nomotion_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_NOMOTION);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Write the No motion interrupt
- * interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 3 in the register 0x55
- * @brief interrupt2 bit 3 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of no motion selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_NOMO
- * 1 | BMI160_INTR2_MAP_NOMO
- *
- * @param v_intr_nomotion_u8 : The value of no motion enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_nomotion(
- u8 v_channel_u8, u8 v_intr_nomotion_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* write the no motion interrupt*/
- case BMI160_INTR1_MAP_NOMO:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_NOMOTION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_NOMOTION,
- v_intr_nomotion_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_NOMOTION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_MAP_NOMO:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_NOMOTION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_NOMOTION,
- v_intr_nomotion_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_NOMOTION__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Reads the Double Tap interrupt
- * interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 4 in the register 0x55
- * @brief interrupt2 bit 4 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of double tap interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_DOUBLE_TAP
- * 1 | BMI160_INTR2_MAP_DOUBLE_TAP
- *
- * @param v_intr_double_tap_u8 : The value of double tap enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_double_tap(
- u8 v_channel_u8, u8 *v_intr_double_tap_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- case BMI160_INTR1_MAP_DOUBLE_TAP:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_DOUBLE_TAP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_double_tap_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_DOUBLE_TAP);
- break;
- case BMI160_INTR2_MAP_DOUBLE_TAP:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_DOUBLE_TAP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_double_tap_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_DOUBLE_TAP);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Write the Double Tap interrupt
- * interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 4 in the register 0x55
- * @brief interrupt2 bit 4 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of double tap interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_DOUBLE_TAP
- * 1 | BMI160_INTR2_MAP_DOUBLE_TAP
- *
- * @param v_intr_double_tap_u8 : The value of double tap enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_double_tap(
- u8 v_channel_u8, u8 v_intr_double_tap_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* set the double tap interrupt */
- case BMI160_INTR1_MAP_DOUBLE_TAP:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_DOUBLE_TAP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_DOUBLE_TAP,
- v_intr_double_tap_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_DOUBLE_TAP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_MAP_DOUBLE_TAP:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_DOUBLE_TAP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_DOUBLE_TAP,
- v_intr_double_tap_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_DOUBLE_TAP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Reads the Single Tap interrupt
- * interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 5 in the register 0x55
- * @brief interrupt2 bit 5 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of single tap interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_SINGLE_TAP
- * 1 | BMI160_INTR2_MAP_SINGLE_TAP
- *
- * @param v_intr_single_tap_u8 : The value of single tap enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_single_tap(
- u8 v_channel_u8, u8 *v_intr_single_tap_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* reads the single tap interrupt*/
- case BMI160_INTR1_MAP_SINGLE_TAP:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_SINGLE_TAP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_single_tap_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_SINGLE_TAP);
- break;
- case BMI160_INTR2_MAP_SINGLE_TAP:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_SINGLE_TAP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_single_tap_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_SINGLE_TAP);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Write the Single Tap interrupt
- * interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 5 in the register 0x55
- * @brief interrupt2 bit 5 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of single tap interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_SINGLE_TAP
- * 1 | BMI160_INTR2_MAP_SINGLE_TAP
- *
- * @param v_intr_single_tap_u8 : The value of single tap enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_single_tap(
- u8 v_channel_u8, u8 v_intr_single_tap_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* write the single tap interrupt */
- case BMI160_INTR1_MAP_SINGLE_TAP:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_SINGLE_TAP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_SINGLE_TAP,
- v_intr_single_tap_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_SINGLE_TAP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_MAP_SINGLE_TAP:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_SINGLE_TAP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_SINGLE_TAP,
- v_intr_single_tap_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_SINGLE_TAP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Reads the Orient interrupt
- * interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 6 in the register 0x55
- * @brief interrupt2 bit 6 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of orient interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_ORIENT
- * 1 | BMI160_INTR2_MAP_ORIENT
- *
- * @param v_intr_orient_u8 : The value of orient enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_orient(
- u8 v_channel_u8, u8 *v_intr_orient_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* read the orientation interrupt*/
- case BMI160_INTR1_MAP_ORIENT:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_ORIENT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_orient_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_ORIENT);
- break;
- case BMI160_INTR2_MAP_ORIENT:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_ORIENT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_orient_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_ORIENT);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Write the Orient interrupt
- * interrupt mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 6 in the register 0x55
- * @brief interrupt2 bit 6 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of orient interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_ORIENT
- * 1 | BMI160_INTR2_MAP_ORIENT
- *
- * @param v_intr_orient_u8 : The value of orient enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_orient(
- u8 v_channel_u8, u8 v_intr_orient_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* write the orientation interrupt*/
- case BMI160_INTR1_MAP_ORIENT:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_ORIENT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_ORIENT, v_intr_orient_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_ORIENT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_MAP_ORIENT:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_ORIENT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_ORIENT, v_intr_orient_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_ORIENT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Reads the Flat interrupt
- * mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 7 in the register 0x55
- * @brief interrupt2 bit 7 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of flat interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_FLAT
- * 1 | BMI160_INTR2_MAP_FLAT
- *
- * @param v_intr_flat_u8 : The value of flat enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_flat(
- u8 v_channel_u8, u8 *v_intr_flat_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* read the flat interrupt*/
- case BMI160_INTR1_MAP_FLAT:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_FLAT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_flat_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_FLAT);
- break;
- case BMI160_INTR2_MAP_FLAT:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_FLAT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_flat_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_FLAT);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Write the Flat interrupt
- * mapped to interrupt1
- * and interrupt2 from the register 0x55 and 0x57
- * @brief interrupt1 bit 7 in the register 0x55
- * @brief interrupt2 bit 7 in the register 0x57
- *
- *
- * @param v_channel_u8: The value of flat interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_FLAT
- * 1 | BMI160_INTR2_MAP_FLAT
- *
- * @param v_intr_flat_u8 : The value of flat enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_flat(
- u8 v_channel_u8, u8 v_intr_flat_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* write the flat interrupt */
- case BMI160_INTR1_MAP_FLAT:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_0_INTR1_FLAT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_0_INTR1_FLAT,
- v_intr_flat_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_MAP_0_INTR1_FLAT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_MAP_FLAT:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_2_INTR2_FLAT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_2_INTR2_FLAT,
- v_intr_flat_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_MAP_2_INTR2_FLAT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Reads PMU trigger interrupt mapped to interrupt1
- * and interrupt2 form the register 0x56 bit 0 and 4
- * @brief interrupt1 bit 0 in the register 0x56
- * @brief interrupt2 bit 4 in the register 0x56
- *
- *
- * @param v_channel_u8: The value of pmu trigger selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_PMUTRIG
- * 1 | BMI160_INTR2_MAP_PMUTRIG
- *
- * @param v_intr_pmu_trig_u8 : The value of pmu trigger enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_pmu_trig(
- u8 v_channel_u8, u8 *v_intr_pmu_trig_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* read the pmu trigger interrupt*/
- case BMI160_INTR1_MAP_PMUTRIG:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR1_PMU_TRIG__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_pmu_trig_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR1_PMU_TRIG);
- break;
- case BMI160_INTR2_MAP_PMUTRIG:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR2_PMU_TRIG__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_pmu_trig_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR2_PMU_TRIG);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Write PMU trigger interrupt mapped to interrupt1
- * and interrupt2 form the register 0x56 bit 0 and 4
- * @brief interrupt1 bit 0 in the register 0x56
- * @brief interrupt2 bit 4 in the register 0x56
- *
- *
- * @param v_channel_u8: The value of pmu trigger selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_PMUTRIG
- * 1 | BMI160_INTR2_MAP_PMUTRIG
- *
- * @param v_intr_pmu_trig_u8 : The value of pmu trigger enable
- * value | trigger enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_pmu_trig(
- u8 v_channel_u8, u8 v_intr_pmu_trig_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* write the pmu trigger interrupt */
- case BMI160_INTR1_MAP_PMUTRIG:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR1_PMU_TRIG__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR1_PMU_TRIG,
- v_intr_pmu_trig_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR1_PMU_TRIG__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_MAP_PMUTRIG:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR2_PMU_TRIG__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR2_PMU_TRIG,
- v_intr_pmu_trig_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR2_PMU_TRIG__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Reads FIFO Full interrupt mapped to interrupt1
- * and interrupt2 form the register 0x56 bit 5 and 1
- * @brief interrupt1 bit 5 in the register 0x56
- * @brief interrupt2 bit 1 in the register 0x56
- *
- *
- * @param v_channel_u8: The value of fifo full interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_FIFO_FULL
- * 1 | BMI160_INTR2_MAP_FIFO_FULL
- *
- * @param v_intr_fifo_full_u8 : The value of fifo full interrupt enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_fifo_full(
- u8 v_channel_u8, u8 *v_intr_fifo_full_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* read the fifo full interrupt */
- case BMI160_INTR1_MAP_FIFO_FULL:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR1_FIFO_FULL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_fifo_full_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR1_FIFO_FULL);
- break;
- case BMI160_INTR2_MAP_FIFO_FULL:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR2_FIFO_FULL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_fifo_full_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR2_FIFO_FULL);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Write FIFO Full interrupt mapped to interrupt1
- * and interrupt2 form the register 0x56 bit 5 and 1
- * @brief interrupt1 bit 5 in the register 0x56
- * @brief interrupt2 bit 1 in the register 0x56
- *
- *
- * @param v_channel_u8: The value of fifo full interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_FIFO_FULL
- * 1 | BMI160_INTR2_MAP_FIFO_FULL
- *
- * @param v_intr_fifo_full_u8 : The value of fifo full interrupt enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_fifo_full(
- u8 v_channel_u8, u8 v_intr_fifo_full_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* write the fifo full interrupt */
- case BMI160_INTR1_MAP_FIFO_FULL:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR1_FIFO_FULL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR1_FIFO_FULL,
- v_intr_fifo_full_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_MAP_1_INTR1_FIFO_FULL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_MAP_FIFO_FULL:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR2_FIFO_FULL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR2_FIFO_FULL,
- v_intr_fifo_full_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_MAP_1_INTR2_FIFO_FULL__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Reads FIFO Watermark interrupt mapped to interrupt1
- * and interrupt2 form the register 0x56 bit 6 and 2
- * @brief interrupt1 bit 6 in the register 0x56
- * @brief interrupt2 bit 2 in the register 0x56
- *
- *
- * @param v_channel_u8: The value of fifo Watermark interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_FIFO_WM
- * 1 | BMI160_INTR2_MAP_FIFO_WM
- *
- * @param v_intr_fifo_wm_u8 : The value of fifo Watermark interrupt enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_fifo_wm(
- u8 v_channel_u8, u8 *v_intr_fifo_wm_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* read the fifo water mark interrupt */
- case BMI160_INTR1_MAP_FIFO_WM:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR1_FIFO_WM__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_fifo_wm_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR1_FIFO_WM);
- break;
- case BMI160_INTR2_MAP_FIFO_WM:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR2_FIFO_WM__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_fifo_wm_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR2_FIFO_WM);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Write FIFO Watermark interrupt mapped to interrupt1
- * and interrupt2 form the register 0x56 bit 6 and 2
- * @brief interrupt1 bit 6 in the register 0x56
- * @brief interrupt2 bit 2 in the register 0x56
- *
- *
- * @param v_channel_u8: The value of fifo Watermark interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_FIFO_WM
- * 1 | BMI160_INTR2_MAP_FIFO_WM
- *
- * @param v_intr_fifo_wm_u8 : The value of fifo Watermark interrupt enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_fifo_wm(
- u8 v_channel_u8, u8 v_intr_fifo_wm_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* write the fifo water mark interrupt */
- case BMI160_INTR1_MAP_FIFO_WM:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR1_FIFO_WM__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR1_FIFO_WM,
- v_intr_fifo_wm_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_MAP_1_INTR1_FIFO_WM__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_MAP_FIFO_WM:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR2_FIFO_WM__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR2_FIFO_WM,
- v_intr_fifo_wm_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr,
- BMI160_USER_INTR_MAP_1_INTR2_FIFO_WM__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Reads Data Ready interrupt mapped to interrupt1
- * and interrupt2 form the register 0x56
- * @brief interrupt1 bit 7 in the register 0x56
- * @brief interrupt2 bit 3 in the register 0x56
- *
- *
- * @param v_channel_u8: The value of data ready interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_DATA_RDY
- * 1 | BMI160_INTR2_MAP_DATA_RDY
- *
- * @param v_intr_data_rdy_u8 : The value of data ready interrupt enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_data_rdy(
- u8 v_channel_u8, u8 *v_intr_data_rdy_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /*Read Data Ready interrupt*/
- case BMI160_INTR1_MAP_DATA_RDY:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR1_DATA_RDY__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_data_rdy_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR1_DATA_RDY);
- break;
- case BMI160_INTR2_MAP_DATA_RDY:
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR2_DATA_RDY__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_data_rdy_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR2_DATA_RDY);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief Write Data Ready interrupt mapped to interrupt1
- * and interrupt2 form the register 0x56
- * @brief interrupt1 bit 7 in the register 0x56
- * @brief interrupt2 bit 3 in the register 0x56
- *
- *
- * @param v_channel_u8: The value of data ready interrupt selection
- * v_channel_u8 | interrupt
- * ---------------|---------------
- * 0 | BMI160_INTR1_MAP_DATA_RDY
- * 1 | BMI160_INTR2_MAP_DATA_RDY
- *
- * @param v_intr_data_rdy_u8 : The value of data ready interrupt enable
- * value | interrupt enable
- * ----------|-------------------
- * 0x01 | BMI160_ENABLE
- * 0x00 | BMI160_DISABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_data_rdy(
- u8 v_channel_u8, u8 v_intr_data_rdy_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /*Write Data Ready interrupt*/
- case BMI160_INTR1_MAP_DATA_RDY:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR1_DATA_RDY__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR1_DATA_RDY,
- v_intr_data_rdy_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR1_DATA_RDY__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_INTR2_MAP_DATA_RDY:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR2_DATA_RDY__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MAP_1_INTR2_DATA_RDY,
- v_intr_data_rdy_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(p_bmi160->
- dev_addr, BMI160_USER_INTR_MAP_1_INTR2_DATA_RDY__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads data source for the interrupt
- * engine for the single and double tap interrupts from the register
- * 0x58 bit 3
- *
- *
- * @param v_tap_source_u8 : The value of the tap source
- * value | Description
- * ----------|-------------------
- * 0x01 | UNFILTER_DATA
- * 0x00 | FILTER_DATA
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_tap_source(u8 *v_tap_source_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the tap source interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_DATA_0_INTR_TAP_SOURCE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_tap_source_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_DATA_0_INTR_TAP_SOURCE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write data source for the interrupt
- * engine for the single and double tap interrupts from the register
- * 0x58 bit 3
- *
- *
- * @param v_tap_source_u8 : The value of the tap source
- * value | Description
- * ----------|-------------------
- * 0x01 | UNFILTER_DATA
- * 0x00 | FILTER_DATA
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_tap_source(
- u8 v_tap_source_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_tap_source_u8 < C_BMI160_TWO_U8X) {
- /* write the tap source interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_DATA_0_INTR_TAP_SOURCE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_DATA_0_INTR_TAP_SOURCE,
- v_tap_source_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_DATA_0_INTR_TAP_SOURCE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API Reads Data source for the
- * interrupt engine for the low and high g interrupts
- * from the register 0x58 bit 7
- *
- * @param v_low_high_source_u8 : The value of the tap source
- * value | Description
- * ----------|-------------------
- * 0x01 | UNFILTER_DATA
- * 0x00 | FILTER_DATA
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_low_high_source(
- u8 *v_low_high_source_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the high_low_g source interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_DATA_0_INTR_LOW_HIGH_SOURCE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_low_high_source_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_DATA_0_INTR_LOW_HIGH_SOURCE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write Data source for the
- * interrupt engine for the low and high g interrupts
- * from the register 0x58 bit 7
- *
- * @param v_low_high_source_u8 : The value of the tap source
- * value | Description
- * ----------|-------------------
- * 0x01 | UNFILTER_DATA
- * 0x00 | FILTER_DATA
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_low_high_source(
- u8 v_low_high_source_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_low_high_source_u8 < C_BMI160_TWO_U8X) {
- /* write the high_low_g source interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_DATA_0_INTR_LOW_HIGH_SOURCE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_DATA_0_INTR_LOW_HIGH_SOURCE,
- v_low_high_source_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_DATA_0_INTR_LOW_HIGH_SOURCE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads Data source for the
- * interrupt engine for the nomotion and anymotion interrupts
- * from the register 0x59 bit 7
- *
- * @param v_motion_source_u8 :
- * The value of the any/no motion interrupt source
- * value | Description
- * ----------|-------------------
- * 0x01 | UNFILTER_DATA
- * 0x00 | FILTER_DATA
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_motion_source(
- u8 *v_motion_source_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the any/no motion interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_DATA_1_INTR_MOTION_SOURCE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_motion_source_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_DATA_1_INTR_MOTION_SOURCE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write Data source for the
- * interrupt engine for the nomotion and anymotion interrupts
- * from the register 0x59 bit 7
- *
- * @param v_motion_source_u8 :
- * The value of the any/no motion interrupt source
- * value | Description
- * ----------|-------------------
- * 0x01 | UNFILTER_DATA
- * 0x00 | FILTER_DATA
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_motion_source(
- u8 v_motion_source_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_motion_source_u8 < C_BMI160_TWO_U8X) {
- /* write the any/no motion interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_DATA_1_INTR_MOTION_SOURCE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_DATA_1_INTR_MOTION_SOURCE,
- v_motion_source_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_DATA_1_INTR_MOTION_SOURCE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read the low_g duration from register
- * 0x5A bit 0 to 7
- *
- *
- *
- *
- * @param v_low_g_durn_u8 : The value of low_g duration
- *
- * @note Low_g duration trigger trigger delay according to
- * "(v_low_g_durn_u8 * 2.5)ms" in a range from 2.5ms to 640ms.
- * the default corresponds delay is 20ms
- * @note When low_g data source of interrupt is unfiltered
- * the sensor must not be in low power mode
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_low_g_durn(
- u8 *v_low_g_durn_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the low_g interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_0_INTR_LOW_DURN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_low_g_durn_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_LOWHIGH_0_INTR_LOW_DURN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to write the low_g duration from register
- * 0x5A bit 0 to 7
- *
- *
- *
- *
- * @param v_low_g_durn_u8 : The value of low_g duration
- *
- * @note Low_g duration trigger trigger delay according to
- * "(v_low_g_durn_u8 * 2.5)ms" in a range from 2.5ms to 640ms.
- * the default corresponds delay is 20ms
- * @note When low_g data source of interrupt is unfiltered
- * the sensor must not be in low power mode
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_low_g_durn(u8 v_low_g_durn_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write the low_g interrupt */
- com_rslt = p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_0_INTR_LOW_DURN__REG,
- &v_low_g_durn_u8, C_BMI160_ONE_U8X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read Threshold
- * definition for the low-g interrupt from the register 0x5B bit 0 to 7
- *
- *
- *
- *
- * @param v_low_g_thres_u8 : The value of low_g threshold
- *
- * @note Low_g interrupt trigger threshold according to
- * (v_low_g_thres_u8 * 7.81)mg for v_low_g_thres_u8 > 0
- * 3.91 mg for v_low_g_thres_u8 = 0
- * The threshold range is form 3.91mg to 2.000mg
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_low_g_thres(
- u8 *v_low_g_thres_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read low_g threshold */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_1_INTR_LOW_THRES__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_low_g_thres_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_LOWHIGH_1_INTR_LOW_THRES);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to write Threshold
- * definition for the low-g interrupt from the register 0x5B bit 0 to 7
- *
- *
- *
- *
- * @param v_low_g_thres_u8 : The value of low_g threshold
- *
- * @note Low_g interrupt trigger threshold according to
- * (v_low_g_thres_u8 * 7.81)mg for v_low_g_thres_u8 > 0
- * 3.91 mg for v_low_g_thres_u8 = 0
- * The threshold range is form 3.91mg to 2.000mg
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_low_g_thres(
- u8 v_low_g_thres_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write low_g threshold */
- com_rslt = p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_1_INTR_LOW_THRES__REG,
- &v_low_g_thres_u8, C_BMI160_ONE_U8X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API Reads Low-g interrupt hysteresis
- * from the register 0x5C bit 0 to 1
- *
- * @param v_low_hyst_u8 :The value of low_g hysteresis
- *
- * @note Low_g hysteresis calculated by v_low_hyst_u8*125 mg
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_low_g_hyst(
- u8 *v_low_hyst_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read low_g hysteresis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_2_INTR_LOW_G_HYST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_low_hyst_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_INTR_LOWHIGH_2_INTR_LOW_G_HYST);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write Low-g interrupt hysteresis
- * from the register 0x5C bit 0 to 1
- *
- * @param v_low_hyst_u8 :The value of low_g hysteresis
- *
- * @note Low_g hysteresis calculated by v_low_hyst_u8*125 mg
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_low_g_hyst(
- u8 v_low_hyst_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write low_g hysteresis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_2_INTR_LOW_G_HYST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_LOWHIGH_2_INTR_LOW_G_HYST,
- v_low_hyst_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_2_INTR_LOW_G_HYST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads Low-g interrupt mode
- * from the register 0x5C bit 2
- *
- * @param v_low_g_mode_u8 : The value of low_g mode
- * Value | Description
- * ----------|-----------------
- * 0 | single-axis
- * 1 | axis-summing
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_low_g_mode(u8 *v_low_g_mode_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /*read Low-g interrupt mode*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_2_INTR_LOW_G_MODE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_low_g_mode_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_LOWHIGH_2_INTR_LOW_G_MODE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write Low-g interrupt mode
- * from the register 0x5C bit 2
- *
- * @param v_low_g_mode_u8 : The value of low_g mode
- * Value | Description
- * ----------|-----------------
- * 0 | single-axis
- * 1 | axis-summing
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_low_g_mode(
- u8 v_low_g_mode_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_low_g_mode_u8 < C_BMI160_TWO_U8X) {
- /*write Low-g interrupt mode*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_2_INTR_LOW_G_MODE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_LOWHIGH_2_INTR_LOW_G_MODE,
- v_low_g_mode_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_2_INTR_LOW_G_MODE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads High-g interrupt hysteresis
- * from the register 0x5C bit 6 and 7
- *
- * @param v_high_g_hyst_u8 : The value of high hysteresis
- *
- * @note High_g hysteresis changes according to accel g range
- * accel g range can be set by the function ""
- * accel_range | high_g hysteresis
- * ----------------|---------------------
- * 2g | high_hy*125 mg
- * 4g | high_hy*250 mg
- * 8g | high_hy*500 mg
- * 16g | high_hy*1000 mg
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_high_g_hyst(
- u8 *v_high_g_hyst_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read high_g hysteresis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_2_INTR_HIGH_G_HYST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_high_g_hyst_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_LOWHIGH_2_INTR_HIGH_G_HYST);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write High-g interrupt hysteresis
- * from the register 0x5C bit 6 and 7
- *
- * @param v_high_g_hyst_u8 : The value of high hysteresis
- *
- * @note High_g hysteresis changes according to accel g range
- * accel g range can be set by the function ""
- * accel_range | high_g hysteresis
- * ----------------|---------------------
- * 2g | high_hy*125 mg
- * 4g | high_hy*250 mg
- * 8g | high_hy*500 mg
- * 16g | high_hy*1000 mg
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_high_g_hyst(
- u8 v_high_g_hyst_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write high_g hysteresis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_2_INTR_HIGH_G_HYST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_LOWHIGH_2_INTR_HIGH_G_HYST,
- v_high_g_hyst_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_2_INTR_HIGH_G_HYST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read Delay
- * time definition for the high-g interrupt from the register
- * 0x5D bit 0 to 7
- *
- *
- *
- * @param v_high_g_durn_u8 : The value of high duration
- *
- * @note High_g interrupt delay triggered according to
- * v_high_g_durn_u8 * 2.5ms in a range from 2.5ms to 640ms
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_high_g_durn(
- u8 *v_high_g_durn_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read high_g duration*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_3_INTR_HIGH_G_DURN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_high_g_durn_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_LOWHIGH_3_INTR_HIGH_G_DURN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to write Delay
- * time definition for the high-g interrupt from the register
- * 0x5D bit 0 to 7
- *
- *
- *
- * @param v_high_g_durn_u8 : The value of high duration
- *
- * @note High_g interrupt delay triggered according to
- * v_high_g_durn_u8 * 2.5ms in a range from 2.5ms to 640ms
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_high_g_durn(
- u8 v_high_g_durn_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write high_g duration*/
- com_rslt = p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_3_INTR_HIGH_G_DURN__REG,
- &v_high_g_durn_u8, C_BMI160_ONE_U8X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read Threshold
- * definition for the high-g interrupt from the register 0x5E 0 to 7
- *
- *
- *
- *
- * @param v_high_g_thres_u8 : Pointer holding the value of Threshold
- * @note High_g threshold changes according to accel g range
- * accel g range can be set by the function ""
- * accel_range | high_g threshold
- * ----------------|---------------------
- * 2g | v_high_g_thres_u8*7.81 mg
- * 4g | v_high_g_thres_u8*15.63 mg
- * 8g | v_high_g_thres_u8*31.25 mg
- * 16g | v_high_g_thres_u8*62.5 mg
- * @note when v_high_g_thres_u8 = 0
- * accel_range | high_g threshold
- * ----------------|---------------------
- * 2g | 3.91 mg
- * 4g | 7.81 mg
- * 8g | 15.63 mg
- * 16g | 31.25 mg
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_high_g_thres(
- u8 *v_high_g_thres_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_4_INTR_HIGH_THRES__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_high_g_thres_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_LOWHIGH_4_INTR_HIGH_THRES);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to write Threshold
- * definition for the high-g interrupt from the register 0x5E 0 to 7
- *
- *
- *
- *
- * @param v_high_g_thres_u8 : Pointer holding the value of Threshold
- * @note High_g threshold changes according to accel g range
- * accel g range can be set by the function ""
- * accel_range | high_g threshold
- * ----------------|---------------------
- * 2g | v_high_g_thres_u8*7.81 mg
- * 4g | v_high_g_thres_u8*15.63 mg
- * 8g | v_high_g_thres_u8*31.25 mg
- * 16g | v_high_g_thres_u8*62.5 mg
- * @note when v_high_g_thres_u8 = 0
- * accel_range | high_g threshold
- * ----------------|---------------------
- * 2g | 3.91 mg
- * 4g | 7.81 mg
- * 8g | 15.63 mg
- * 16g | 31.25 mg
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_high_g_thres(
- u8 v_high_g_thres_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- com_rslt = p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_LOWHIGH_4_INTR_HIGH_THRES__REG,
- &v_high_g_thres_u8, C_BMI160_ONE_U8X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads any motion duration
- * from the register 0x5F bit 0 and 1
- *
- * @param v_any_motion_durn_u8 : The value of any motion duration
- *
- * @note Any motion duration can be calculated by "v_any_motion_durn_u8 + 1"
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_any_motion_durn(
- u8 *v_any_motion_durn_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read any motion duration*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_0_INTR_ANY_MOTION_DURN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_any_motion_durn_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_MOTION_0_INTR_ANY_MOTION_DURN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write any motion duration
- * from the register 0x5F bit 0 and 1
- *
- * @param v_any_motion_durn_u8 : The value of any motion duration
- *
- * @note Any motion duration can be calculated by "v_any_motion_durn_u8 + 1"
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_any_motion_durn(
- u8 v_any_motion_durn_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write any motion duration*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_0_INTR_ANY_MOTION_DURN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MOTION_0_INTR_ANY_MOTION_DURN,
- v_any_motion_durn_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_0_INTR_ANY_MOTION_DURN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read Slow/no-motion
- * interrupt trigger delay duration from the register 0x5F bit 2 to 7
- *
- * @param v_slow_no_motion_u8 :The value of slow no motion duration
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- * @note
- * @note v_slow_no_motion_u8(5:4)=0b00 ->
- * [v_slow_no_motion_u8(3:0) + 1] * 1.28s (1.28s-20.48s)
- * @note v_slow_no_motion_u8(5:4)=1 ->
- * [v_slow_no_motion_u8(3:0)+5] * 5.12s (25.6s-102.4s)
- * @note v_slow_no_motion_u8(5)='1' ->
- * [(v_slow_no_motion_u8:0)+11] * 10.24s (112.64s-430.08s);
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_slow_no_motion_durn(
- u8 *v_slow_no_motion_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read slow no motion duration*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_0_INTR_SLOW_NO_MOTION_DURN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_slow_no_motion_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_MOTION_0_INTR_SLOW_NO_MOTION_DURN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write Slow/no-motion
- * interrupt trigger delay duration from the register 0x5F bit 2 to 7
- *
- * @param v_slow_no_motion_u8 :The value of slow no motion duration
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- * @note
- * @note v_slow_no_motion_u8(5:4)=0b00 ->
- * [v_slow_no_motion_u8(3:0) + 1] * 1.28s (1.28s-20.48s)
- * @note v_slow_no_motion_u8(5:4)=1 ->
- * [v_slow_no_motion_u8(3:0)+5] * 5.12s (25.6s-102.4s)
- * @note v_slow_no_motion_u8(5)='1' ->
- * [(v_slow_no_motion_u8:0)+11] * 10.24s (112.64s-430.08s);
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_slow_no_motion_durn(
- u8 v_slow_no_motion_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write slow no motion duration*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_0_INTR_SLOW_NO_MOTION_DURN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_MOTION_0_INTR_SLOW_NO_MOTION_DURN,
- v_slow_no_motion_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_0_INTR_SLOW_NO_MOTION_DURN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read threshold
- * definition for the any-motion interrupt
- * from the register 0x60 bit 0 to 7
- *
- *
- * @param v_any_motion_thres_u8 : The value of any motion threshold
- *
- * @note any motion threshold changes according to accel g range
- * accel g range can be set by the function ""
- * accel_range | any motion threshold
- * ----------------|---------------------
- * 2g | v_any_motion_thres_u8*3.91 mg
- * 4g | v_any_motion_thres_u8*7.81 mg
- * 8g | v_any_motion_thres_u8*15.63 mg
- * 16g | v_any_motion_thres_u8*31.25 mg
- * @note when v_any_motion_thres_u8 = 0
- * accel_range | any motion threshold
- * ----------------|---------------------
- * 2g | 1.95 mg
- * 4g | 3.91 mg
- * 8g | 7.81 mg
- * 16g | 15.63 mg
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_any_motion_thres(
- u8 *v_any_motion_thres_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read any motion threshold*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_1_INTR_ANY_MOTION_THRES__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_any_motion_thres_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MOTION_1_INTR_ANY_MOTION_THRES);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to write threshold
- * definition for the any-motion interrupt
- * from the register 0x60 bit 0 to 7
- *
- *
- * @param v_any_motion_thres_u8 : The value of any motion threshold
- *
- * @note any motion threshold changes according to accel g range
- * accel g range can be set by the function ""
- * accel_range | any motion threshold
- * ----------------|---------------------
- * 2g | v_any_motion_thres_u8*3.91 mg
- * 4g | v_any_motion_thres_u8*7.81 mg
- * 8g | v_any_motion_thres_u8*15.63 mg
- * 16g | v_any_motion_thres_u8*31.25 mg
- * @note when v_any_motion_thres_u8 = 0
- * accel_range | any motion threshold
- * ----------------|---------------------
- * 2g | 1.95 mg
- * 4g | 3.91 mg
- * 8g | 7.81 mg
- * 16g | 15.63 mg
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_any_motion_thres(
- u8 v_any_motion_thres_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write any motion threshold*/
- com_rslt = p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_1_INTR_ANY_MOTION_THRES__REG,
- &v_any_motion_thres_u8, C_BMI160_ONE_U8X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read threshold
- * for the slow/no-motion interrupt
- * from the register 0x61 bit 0 to 7
- *
- *
- *
- *
- * @param v_slow_no_motion_thres_u8 : The value of slow no motion threshold
- * @note slow no motion threshold changes according to accel g range
- * accel g range can be set by the function ""
- * accel_range | slow no motion threshold
- * ----------------|---------------------
- * 2g | v_slow_no_motion_thres_u8*3.91 mg
- * 4g | v_slow_no_motion_thres_u8*7.81 mg
- * 8g | v_slow_no_motion_thres_u8*15.63 mg
- * 16g | v_slow_no_motion_thres_u8*31.25 mg
- * @note when v_slow_no_motion_thres_u8 = 0
- * accel_range | slow no motion threshold
- * ----------------|---------------------
- * 2g | 1.95 mg
- * 4g | 3.91 mg
- * 8g | 7.81 mg
- * 16g | 15.63 mg
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_slow_no_motion_thres(
- u8 *v_slow_no_motion_thres_u8)
- {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read slow no motion threshold*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_2_INTR_SLOW_NO_MOTION_THRES__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_slow_no_motion_thres_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MOTION_2_INTR_SLOW_NO_MOTION_THRES);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to write threshold
- * for the slow/no-motion interrupt
- * from the register 0x61 bit 0 to 7
- *
- *
- *
- *
- * @param v_slow_no_motion_thres_u8 : The value of slow no motion threshold
- * @note slow no motion threshold changes according to accel g range
- * accel g range can be set by the function ""
- * accel_range | slow no motion threshold
- * ----------------|---------------------
- * 2g | v_slow_no_motion_thres_u8*3.91 mg
- * 4g | v_slow_no_motion_thres_u8*7.81 mg
- * 8g | v_slow_no_motion_thres_u8*15.63 mg
- * 16g | v_slow_no_motion_thres_u8*31.25 mg
- * @note when v_slow_no_motion_thres_u8 = 0
- * accel_range | slow no motion threshold
- * ----------------|---------------------
- * 2g | 1.95 mg
- * 4g | 3.91 mg
- * 8g | 7.81 mg
- * 16g | 15.63 mg
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_slow_no_motion_thres(
- u8 v_slow_no_motion_thres_u8)
- {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write slow no motion threshold*/
- com_rslt = p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_2_INTR_SLOW_NO_MOTION_THRES__REG,
- &v_slow_no_motion_thres_u8, C_BMI160_ONE_U8X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * the slow/no-motion selection from the register 0x62 bit 0
- *
- *
- *
- *
- * @param v_intr_slow_no_motion_select_u8 :
- * The value of slow/no-motion select
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | SLOW_MOTION
- * 0x01 | NO_MOTION
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_slow_no_motion_select(
- u8 *v_intr_slow_no_motion_select_u8)
- {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read slow no motion select*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_3_INTR_SLOW_NO_MOTION_SELECT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_slow_no_motion_select_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MOTION_3_INTR_SLOW_NO_MOTION_SELECT);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to write
- * the slow/no-motion selection from the register 0x62 bit 0
- *
- *
- *
- *
- * @param v_intr_slow_no_motion_select_u8 :
- * The value of slow/no-motion select
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | SLOW_MOTION
- * 0x01 | NO_MOTION
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_slow_no_motion_select(
- u8 v_intr_slow_no_motion_select_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_intr_slow_no_motion_select_u8 < C_BMI160_TWO_U8X) {
- /* write slow no motion select*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_3_INTR_SLOW_NO_MOTION_SELECT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_MOTION_3_INTR_SLOW_NO_MOTION_SELECT,
- v_intr_slow_no_motion_select_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_MOTION_3_INTR_SLOW_NO_MOTION_SELECT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to select
- * the significant or any motion interrupt from the register 0x62 bit 1
- *
- *
- *
- *
- * @param v_intr_significant_motion_select_u8 :
- * the value of significant or any motion interrupt selection
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | ANY_MOTION
- * 0x01 | SIGNIFICANT_MOTION
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_significant_motion_select(
- u8 *v_intr_significant_motion_select_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the significant or any motion interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_SIGNIFICATION_MOTION_SELECT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_intr_significant_motion_select_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_SIGNIFICATION_MOTION_SELECT);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to write, select
- * the significant or any motion interrupt from the register 0x62 bit 1
- *
- *
- *
- *
- * @param v_intr_significant_motion_select_u8 :
- * the value of significant or any motion interrupt selection
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | ANY_MOTION
- * 0x01 | SIGNIFICANT_MOTION
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_significant_motion_select(
- u8 v_intr_significant_motion_select_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_intr_significant_motion_select_u8 < C_BMI160_TWO_U8X) {
- /* write the significant or any motion interrupt*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_SIGNIFICATION_MOTION_SELECT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_SIGNIFICATION_MOTION_SELECT,
- v_intr_significant_motion_select_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_SIGNIFICATION_MOTION_SELECT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * the significant skip time from the register 0x62 bit 2 and 3
- *
- *
- *
- *
- * @param v_int_sig_mot_skip_u8 : the value of significant skip time
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | skip time 1.5 seconds
- * 0x01 | skip time 3 seconds
- * 0x02 | skip time 6 seconds
- * 0x03 | skip time 12 seconds
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_significant_motion_skip(
- u8 *v_int_sig_mot_skip_u8)
- {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read significant skip time*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_SIGNIFICANT_MOTION_SKIP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_int_sig_mot_skip_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_SIGNIFICANT_MOTION_SKIP);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to write
- * the significant skip time from the register 0x62 bit 2 and 3
- *
- *
- *
- *
- * @param v_int_sig_mot_skip_u8 : the value of significant skip time
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | skip time 1.5 seconds
- * 0x01 | skip time 3 seconds
- * 0x02 | skip time 6 seconds
- * 0x03 | skip time 12 seconds
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_significant_motion_skip(
- u8 v_int_sig_mot_skip_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_int_sig_mot_skip_u8 < C_BMI160_EIGHT_U8X) {
- /* write significant skip time*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_SIGNIFICANT_MOTION_SKIP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_SIGNIFICANT_MOTION_SKIP,
- v_int_sig_mot_skip_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_SIGNIFICANT_MOTION_SKIP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * the significant proof time from the register 0x62 bit 4 and 5
- *
- *
- *
- *
- * @param v_significant_motion_proof_u8 :
- * the value of significant proof time
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | proof time 0.25 seconds
- * 0x01 | proof time 0.5 seconds
- * 0x02 | proof time 1 seconds
- * 0x03 | proof time 2 seconds
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_significant_motion_proof(
- u8 *v_significant_motion_proof_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read significant proof time */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_SIGNIFICANT_MOTION_PROOF__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_significant_motion_proof_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_SIGNIFICANT_MOTION_PROOF);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to write
- * the significant proof time from the register 0x62 bit 4 and 5
- *
- *
- *
- *
- * @param v_significant_motion_proof_u8 :
- * the value of significant proof time
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | proof time 0.25 seconds
- * 0x01 | proof time 0.5 seconds
- * 0x02 | proof time 1 seconds
- * 0x03 | proof time 2 seconds
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_significant_motion_proof(
- u8 v_significant_motion_proof_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_significant_motion_proof_u8 < C_BMI160_EIGHT_U8X) {
- /* write significant proof time */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_SIGNIFICANT_MOTION_PROOF__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_SIGNIFICANT_MOTION_PROOF,
- v_significant_motion_proof_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_SIGNIFICANT_MOTION_PROOF__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the tap duration
- * from the register 0x63 bit 0 to 2
- *
- *
- *
- * @param v_tap_durn_u8 : The value of tap duration
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | BMI160_TAP_DURN_50MS
- * 0x01 | BMI160_TAP_DURN_100MS
- * 0x03 | BMI160_TAP_DURN_150MS
- * 0x04 | BMI160_TAP_DURN_200MS
- * 0x05 | BMI160_TAP_DURN_250MS
- * 0x06 | BMI160_TAP_DURN_375MS
- * 0x07 | BMI160_TAP_DURN_700MS
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_tap_durn(
- u8 *v_tap_durn_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read tap duration*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_TAP_0_INTR_TAP_DURN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_tap_durn_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_INTR_TAP_0_INTR_TAP_DURN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to write the tap duration
- * from the register 0x63 bit 0 to 2
- *
- *
- *
- * @param v_tap_durn_u8 : The value of tap duration
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | BMI160_TAP_DURN_50MS
- * 0x01 | BMI160_TAP_DURN_100MS
- * 0x03 | BMI160_TAP_DURN_150MS
- * 0x04 | BMI160_TAP_DURN_200MS
- * 0x05 | BMI160_TAP_DURN_250MS
- * 0x06 | BMI160_TAP_DURN_375MS
- * 0x07 | BMI160_TAP_DURN_700MS
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_tap_durn(
- u8 v_tap_durn_u8)
- {
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_tap_durn_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_tap_durn_u8 < C_BMI160_EIGHT_U8X) {
- switch (v_tap_durn_u8) {
- case BMI160_TAP_DURN_50MS:
- v_data_tap_durn_u8 = BMI160_TAP_DURN_50MS;
- break;
- case BMI160_TAP_DURN_100MS:
- v_data_tap_durn_u8 = BMI160_TAP_DURN_100MS;
- break;
- case BMI160_TAP_DURN_150MS:
- v_data_tap_durn_u8 = BMI160_TAP_DURN_150MS;
- break;
- case BMI160_TAP_DURN_200MS:
- v_data_tap_durn_u8 = BMI160_TAP_DURN_200MS;
- break;
- case BMI160_TAP_DURN_250MS:
- v_data_tap_durn_u8 = BMI160_TAP_DURN_250MS;
- break;
- case BMI160_TAP_DURN_375MS:
- v_data_tap_durn_u8 = BMI160_TAP_DURN_375MS;
- break;
- case BMI160_TAP_DURN_500MS:
- v_data_tap_durn_u8 = BMI160_TAP_DURN_500MS;
- break;
- case BMI160_TAP_DURN_700MS:
- v_data_tap_durn_u8 = BMI160_TAP_DURN_700MS;
- break;
- default:
- break;
- }
- /* write tap duration*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_TAP_0_INTR_TAP_DURN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_TAP_0_INTR_TAP_DURN,
- v_data_tap_durn_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_TAP_0_INTR_TAP_DURN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read the
- * tap shock duration from the register 0x63 bit 2
- *
- * @param v_tap_shock_u8 :The value of tap shock
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | BMI160_TAP_SHOCK_50MS
- * 0x01 | BMI160_TAP_SHOCK_75MS
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_tap_shock(
- u8 *v_tap_shock_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read tap shock duration*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_TAP_0_INTR_TAP_SHOCK__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_tap_shock_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_TAP_0_INTR_TAP_SHOCK);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write the
- * tap shock duration from the register 0x63 bit 2
- *
- * @param v_tap_shock_u8 :The value of tap shock
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | BMI160_TAP_SHOCK_50MS
- * 0x01 | BMI160_TAP_SHOCK_75MS
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_tap_shock(u8 v_tap_shock_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_tap_shock_u8 < C_BMI160_TWO_U8X) {
- /* write tap shock duration*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_TAP_0_INTR_TAP_SHOCK__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_TAP_0_INTR_TAP_SHOCK,
- v_tap_shock_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_TAP_0_INTR_TAP_SHOCK__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read
- * tap quiet duration from the register 0x63 bit 7
- *
- *
- * @param v_tap_quiet_u8 : The value of tap quiet
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | BMI160_TAP_QUIET_30MS
- * 0x01 | BMI160_TAP_QUIET_20MS
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_tap_quiet(
- u8 *v_tap_quiet_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read tap quiet duration*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_TAP_0_INTR_TAP_QUIET__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_tap_quiet_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_INTR_TAP_0_INTR_TAP_QUIET);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write
- * tap quiet duration from the register 0x63 bit 7
- *
- *
- * @param v_tap_quiet_u8 : The value of tap quiet
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | BMI160_TAP_QUIET_30MS
- * 0x01 | BMI160_TAP_QUIET_20MS
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_tap_quiet(u8 v_tap_quiet_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_tap_quiet_u8 < C_BMI160_TWO_U8X) {
- /* write tap quiet duration*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_TAP_0_INTR_TAP_QUIET__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_TAP_0_INTR_TAP_QUIET,
- v_tap_quiet_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_TAP_0_INTR_TAP_QUIET__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read Threshold of the
- * single/double tap interrupt from the register 0x64 bit 0 to 4
- *
- *
- * @param v_tap_thres_u8 : The value of single/double tap threshold
- *
- * @note single/double tap threshold changes according to accel g range
- * accel g range can be set by the function ""
- * accel_range | single/double tap threshold
- * ----------------|---------------------
- * 2g | ((v_tap_thres_u8 + 1) * 62.5)mg
- * 4g | ((v_tap_thres_u8 + 1) * 125)mg
- * 8g | ((v_tap_thres_u8 + 1) * 250)mg
- * 16g | ((v_tap_thres_u8 + 1) * 500)mg
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_tap_thres(
- u8 *v_tap_thres_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read tap threshold*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_TAP_1_INTR_TAP_THRES__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_tap_thres_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_TAP_1_INTR_TAP_THRES);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write Threshold of the
- * single/double tap interrupt from the register 0x64 bit 0 to 4
- *
- *
- * @param v_tap_thres_u8 : The value of single/double tap threshold
- *
- * @note single/double tap threshold changes according to accel g range
- * accel g range can be set by the function ""
- * accel_range | single/double tap threshold
- * ----------------|---------------------
- * 2g | ((v_tap_thres_u8 + 1) * 62.5)mg
- * 4g | ((v_tap_thres_u8 + 1) * 125)mg
- * 8g | ((v_tap_thres_u8 + 1) * 250)mg
- * 16g | ((v_tap_thres_u8 + 1) * 500)mg
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_tap_thres(
- u8 v_tap_thres_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write tap threshold*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_TAP_1_INTR_TAP_THRES__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_TAP_1_INTR_TAP_THRES,
- v_tap_thres_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_TAP_1_INTR_TAP_THRES__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read the threshold for orientation interrupt
- * from the register 0x65 bit 0 and 1
- *
- * @param v_orient_mode_u8 : The value of threshold for orientation
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | symmetrical
- * 0x01 | high-asymmetrical
- * 0x02 | low-asymmetrical
- * 0x03 | symmetrical
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_orient_mode(
- u8 *v_orient_mode_u8)
- {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read orientation threshold*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_MODE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_orient_mode_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_MODE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write the threshold for orientation interrupt
- * from the register 0x65 bit 0 and 1
- *
- * @param v_orient_mode_u8 : The value of threshold for orientation
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | symmetrical
- * 0x01 | high-asymmetrical
- * 0x02 | low-asymmetrical
- * 0x03 | symmetrical
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_orient_mode(
- u8 v_orient_mode_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_orient_mode_u8 < C_BMI160_FOUR_U8X) {
- /* write orientation threshold*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_MODE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_MODE,
- v_orient_mode_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_MODE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read the orient blocking mode
- * that is used for the generation of the orientation interrupt.
- * from the register 0x65 bit 2 and 3
- *
- * @param v_orient_blocking_u8 : The value of orient blocking mode
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | No blocking
- * 0x01 | Theta blocking or acceleration in any axis > 1.5g
- * 0x02 | Theta blocking or acceleration slope in any axis >
- * - | 0.2g or acceleration in any axis > 1.5g
- * 0x03 | Theta blocking or acceleration slope in any axis >
- * - | 0.4g or acceleration in any axis >
- * - | 1.5g and value of orient is not stable
- * - | for at least 100 ms
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_orient_blocking(
- u8 *v_orient_blocking_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read orient blocking mode*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_BLOCKING__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_orient_blocking_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_BLOCKING);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write the orient blocking mode
- * that is used for the generation of the orientation interrupt.
- * from the register 0x65 bit 2 and 3
- *
- * @param v_orient_blocking_u8 : The value of orient blocking mode
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | No blocking
- * 0x01 | Theta blocking or acceleration in any axis > 1.5g
- * 0x02 | Theta blocking or acceleration slope in any axis >
- * - | 0.2g or acceleration in any axis > 1.5g
- * 0x03 | Theta blocking or acceleration slope in any axis >
- * - | 0.4g or acceleration in any axis >
- * - | 1.5g and value of orient is not stable
- * - | for at least 100 ms
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_orient_blocking(
- u8 v_orient_blocking_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_orient_blocking_u8 < C_BMI160_FOUR_U8X) {
- /* write orient blocking mode*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_BLOCKING__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_BLOCKING,
- v_orient_blocking_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_BLOCKING__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read Orient interrupt
- * hysteresis, from the register 0x64 bit 4 to 7
- *
- *
- *
- * @param v_orient_hyst_u8 : The value of orient hysteresis
- *
- * @note 1 LSB corresponds to 62.5 mg,
- * irrespective of the selected accel range
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_orient_hyst(
- u8 *v_orient_hyst_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read orient hysteresis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_HYST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_orient_hyst_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_HYST);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write Orient interrupt
- * hysteresis, from the register 0x64 bit 4 to 7
- *
- *
- *
- * @param v_orient_hyst_u8 : The value of orient hysteresis
- *
- * @note 1 LSB corresponds to 62.5 mg,
- * irrespective of the selected accel range
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_orient_hyst(
- u8 v_orient_hyst_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write orient hysteresis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_HYST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_HYST,
- v_orient_hyst_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_HYST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read Orient
- * blocking angle (0 to 44.8) from the register 0x66 bit 0 to 5
- *
- * @param v_orient_theta_u8 : The value of Orient blocking angle
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_orient_theta(
- u8 *v_orient_theta_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read Orient blocking angle*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_THETA__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_orient_theta_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_THETA);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write Orient
- * blocking angle (0 to 44.8) from the register 0x66 bit 0 to 5
- *
- * @param v_orient_theta_u8 : The value of Orient blocking angle
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_orient_theta(
- u8 v_orient_theta_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_orient_theta_u8 <= C_BMI160_THIRTYONE_U8X) {
- /* write Orient blocking angle*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_THETA__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_THETA,
- v_orient_theta_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_THETA__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read orient change
- * of up/down bit from the register 0x66 bit 6
- *
- * @param v_orient_ud_u8 : The value of orient change of up/down
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | Is ignored
- * 0x01 | Generates orientation interrupt
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_orient_ud_enable(
- u8 *v_orient_ud_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read orient up/down enable*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_UD_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_orient_ud_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_UD_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write orient change
- * of up/down bit from the register 0x66 bit 6
- *
- * @param v_orient_ud_u8 : The value of orient change of up/down
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | Is ignored
- * 0x01 | Generates orientation interrupt
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_orient_ud_enable(
- u8 v_orient_ud_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_orient_ud_u8 < C_BMI160_TWO_U8X) {
- /* write orient up/down enable */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_UD_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_UD_ENABLE,
- v_orient_ud_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_UD_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read orientation axes changes
- * from the register 0x66 bit 7
- *
- * @param v_orient_axes_u8 : The value of orient axes assignment
- * value | Behaviour | Name
- * ----------|--------------------|------
- * 0x00 | x = x, y = y, z = z|orient_ax_noex
- * 0x01 | x = y, y = z, z = x|orient_ax_ex
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_orient_axes_enable(
- u8 *v_orient_axes_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read orientation axes changes */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_AXES_EX__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_orient_axes_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_AXES_EX);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write orientation axes changes
- * from the register 0x66 bit 7
- *
- * @param v_orient_axes_u8 : The value of orient axes assignment
- * value | Behaviour | Name
- * ----------|--------------------|------
- * 0x00 | x = x, y = y, z = z|orient_ax_noex
- * 0x01 | x = y, y = z, z = x|orient_ax_ex
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_orient_axes_enable(
- u8 v_orient_axes_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_orient_axes_u8 < C_BMI160_TWO_U8X) {
- /*write orientation axes changes */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_AXES_EX__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_AXES_EX,
- v_orient_axes_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_AXES_EX__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read Flat angle (0 to 44.8) for flat interrupt
- * from the register 0x67 bit 0 to 5
- *
- * @param v_flat_theta_u8 : The value of flat angle
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_flat_theta(
- u8 *v_flat_theta_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read Flat angle*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_FLAT_0_INTR_FLAT_THETA__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_flat_theta_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_FLAT_0_INTR_FLAT_THETA);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write Flat angle (0 to 44.8) for flat interrupt
- * from the register 0x67 bit 0 to 5
- *
- * @param v_flat_theta_u8 : The value of flat angle
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_flat_theta(
- u8 v_flat_theta_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_flat_theta_u8 <= C_BMI160_THIRTYONE_U8X) {
- /* write Flat angle */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_FLAT_0_INTR_FLAT_THETA__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_FLAT_0_INTR_FLAT_THETA,
- v_flat_theta_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_FLAT_0_INTR_FLAT_THETA__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read Flat interrupt hold time;
- * from the register 0x68 bit 4 and 5
- *
- * @param v_flat_hold_u8 : The value of flat hold time
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | 0ms
- * 0x01 | 512ms
- * 0x01 | 1024ms
- * 0x01 | 2048ms
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_flat_hold(
- u8 *v_flat_hold_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read flat hold time*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_FLAT_1_INTR_FLAT_HOLD__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_flat_hold_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_FLAT_1_INTR_FLAT_HOLD);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write Flat interrupt hold time;
- * from the register 0x68 bit 4 and 5
- *
- * @param v_flat_hold_u8 : The value of flat hold time
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | 0ms
- * 0x01 | 512ms
- * 0x01 | 1024ms
- * 0x01 | 2048ms
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_flat_hold(
- u8 v_flat_hold_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_flat_hold_u8 < C_BMI160_FOUR_U8X) {
- /* write flat hold time*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_FLAT_1_INTR_FLAT_HOLD__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_FLAT_1_INTR_FLAT_HOLD,
- v_flat_hold_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_FLAT_1_INTR_FLAT_HOLD__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read flat interrupt hysteresis
- * from the register 0x68 bit 0 to 3
- *
- * @param v_flat_hyst_u8 : The value of flat hysteresis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_intr_flat_hyst(
- u8 *v_flat_hyst_u8)
- {
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the flat hysteresis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_INTR_FLAT_1_INTR_FLAT_HYST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_flat_hyst_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_INTR_FLAT_1_INTR_FLAT_HYST);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write flat interrupt hysteresis
- * from the register 0x68 bit 0 to 3
- *
- * @param v_flat_hyst_u8 : The value of flat hysteresis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_intr_flat_hyst(
- u8 v_flat_hyst_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_flat_hyst_u8 < C_BMI160_SIXTEEN_U8X) {
- /* read the flat hysteresis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_FLAT_1_INTR_FLAT_HYST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_FLAT_1_INTR_FLAT_HYST,
- v_flat_hyst_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_INTR_FLAT_1_INTR_FLAT_HYST__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read accel offset compensation
- * target value for z-axis from the register 0x69 bit 0 and 1
- *
- * @param v_foc_accel_z_u8 : the value of accel offset compensation z axis
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | disable
- * 0x01 | +1g
- * 0x01 | -1g
- * 0x01 | 0g
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_foc_accel_z(u8 *v_foc_accel_z_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the accel offset compensation for z axis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Z__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_foc_accel_z_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_ACCEL_Z);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write accel offset compensation
- * target value for z-axis from the register 0x69 bit 0 and 1
- *
- * @param v_foc_accel_z_u8 : the value of accel offset compensation z axis
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | disable
- * 0x01 | +1g
- * 0x01 | -1g
- * 0x01 | 0g
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_foc_accel_z(
- u8 v_foc_accel_z_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write the accel offset compensation for z axis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Z__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_ACCEL_Z,
- v_foc_accel_z_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Z__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read accel offset compensation
- * target value for y-axis
- * from the register 0x69 bit 2 and 3
- *
- * @param v_foc_accel_y_u8 : the value of accel offset compensation y axis
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | disable
- * 0x01 | +1g
- * 0x01 | -1g
- * 0x01 | 0g
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_foc_accel_y(u8 *v_foc_accel_y_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the accel offset compensation for y axis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Y__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_foc_accel_y_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_ACCEL_Y);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write accel offset compensation
- * target value for y-axis
- * from the register 0x69 bit 2 and 3
- *
- * @param v_foc_accel_y_u8 : the value of accel offset compensation y axis
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | disable
- * 0x01 | +1g
- * 0x01 | -1g
- * 0x01 | 0g
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_foc_accel_y(u8 v_foc_accel_y_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_foc_accel_y_u8 < C_BMI160_FOUR_U8X) {
- /* write the accel offset compensation for y axis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Y__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_ACCEL_Y,
- v_foc_accel_y_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Y__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read accel offset compensation
- * target value for x-axis is
- * from the register 0x69 bit 4 and 5
- *
- * @param v_foc_accel_x_u8 : the value of accel offset compensation x axis
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | disable
- * 0x01 | +1g
- * 0x01 | -1g
- * 0x01 | 0g
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_foc_accel_x(u8 *v_foc_accel_x_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the accel offset compensation for x axis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_X__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_foc_accel_x_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_ACCEL_X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write accel offset compensation
- * target value for x-axis is
- * from the register 0x69 bit 4 and 5
- *
- * @param v_foc_accel_x_u8 : the value of accel offset compensation x axis
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | disable
- * 0x01 | +1g
- * 0x01 | -1g
- * 0x01 | 0g
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_foc_accel_x(u8 v_foc_accel_x_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_foc_accel_x_u8 < C_BMI160_FOUR_U8X) {
- /* write the accel offset compensation for x axis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_X__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_ACCEL_X,
- v_foc_accel_x_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_X__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes accel fast offset compensation
- * from the register 0x69 bit 0 to 5
- * @brief This API writes each axis individually
- * FOC_X_AXIS - bit 4 and 5
- * FOC_Y_AXIS - bit 2 and 3
- * FOC_Z_AXIS - bit 0 and 1
- *
- * @param v_foc_accel_u8: The value of accel offset compensation
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | disable
- * 0x01 | +1g
- * 0x01 | -1g
- * 0x01 | 0g
- *
- * @param v_axis_u8: The value of accel offset axis selection
- * value | axis
- * ----------|-------------------
- * 0 | FOC_X_AXIS
- * 1 | FOC_Y_AXIS
- * 2 | FOC_Z_AXIS
- *
- * @param v_accel_offset_s8: The accel offset value
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_foc_trigger(u8 v_axis_u8,
- u8 v_foc_accel_u8, s8 *v_accel_offset_s8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- s8 v_status_s8 = SUCCESS;
- u8 v_timeout_u8 = C_BMI160_ZERO_U8X;
- s8 v_foc_accel_offset_x_s8 = C_BMI160_ZERO_U8X;
- s8 v_foc_accel_offset_y_s8 = C_BMI160_ZERO_U8X;
- s8 v_foc_accel_offset_z_s8 = C_BMI160_ZERO_U8X;
- u8 focstatus = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- v_status_s8 = bmi160_set_accel_offset_enable(
- ACCEL_OFFSET_ENABLE);
- if (v_status_s8 == SUCCESS) {
- switch (v_axis_u8) {
- case FOC_X_AXIS:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_X__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_ACCEL_X,
- v_foc_accel_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_X__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- /* trigger the
- FOC need to write
- 0x03 in the register 0x7e*/
- com_rslt +=
- bmi160_set_command_register(
- START_FOC_ACCEL_GYRO);
- com_rslt +=
- bmi160_get_foc_rdy(&focstatus);
- if ((com_rslt != SUCCESS) ||
- (focstatus != C_BMI160_ONE_U8X)) {
- while ((com_rslt != SUCCESS) ||
- (focstatus != C_BMI160_ONE_U8X
- && v_timeout_u8 <
- BMI160_MAXIMUM_TIMEOUT)) {
- p_bmi160->delay_msec(
- BMI160_DELAY_SETTLING_TIME);
- com_rslt = bmi160_get_foc_rdy(
- &focstatus);
- v_timeout_u8++;
- }
- }
- if ((com_rslt == SUCCESS) &&
- (focstatus == C_BMI160_ONE_U8X)) {
- com_rslt +=
- bmi160_get_accel_offset_compensation_xaxis(
- &v_foc_accel_offset_x_s8);
- *v_accel_offset_s8 =
- v_foc_accel_offset_x_s8;
- }
- break;
- case FOC_Y_AXIS:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Y__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_ACCEL_Y,
- v_foc_accel_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Y__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- /* trigger the FOC
- need to write 0x03
- in the register 0x7e*/
- com_rslt +=
- bmi160_set_command_register(
- START_FOC_ACCEL_GYRO);
- com_rslt +=
- bmi160_get_foc_rdy(&focstatus);
- if ((com_rslt != SUCCESS) ||
- (focstatus != C_BMI160_ONE_U8X)) {
- while ((com_rslt != SUCCESS) ||
- (focstatus != C_BMI160_ONE_U8X
- && v_timeout_u8 <
- BMI160_MAXIMUM_TIMEOUT)) {
- p_bmi160->delay_msec(
- BMI160_DELAY_SETTLING_TIME);
- com_rslt = bmi160_get_foc_rdy(
- &focstatus);
- v_timeout_u8++;
- }
- }
- if ((com_rslt == SUCCESS) &&
- (focstatus == C_BMI160_ONE_U8X)) {
- com_rslt +=
- bmi160_get_accel_offset_compensation_yaxis(
- &v_foc_accel_offset_y_s8);
- *v_accel_offset_s8 =
- v_foc_accel_offset_y_s8;
- }
- break;
- case FOC_Z_AXIS:
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Z__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_ACCEL_Z,
- v_foc_accel_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Z__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- /* trigger the FOC need to write
- 0x03 in the register 0x7e*/
- com_rslt +=
- bmi160_set_command_register(
- START_FOC_ACCEL_GYRO);
- com_rslt +=
- bmi160_get_foc_rdy(&focstatus);
- if ((com_rslt != SUCCESS) ||
- (focstatus != C_BMI160_ONE_U8X)) {
- while ((com_rslt != SUCCESS) ||
- (focstatus != C_BMI160_ONE_U8X
- && v_timeout_u8 <
- BMI160_MAXIMUM_TIMEOUT)) {
- p_bmi160->delay_msec(
- BMI160_DELAY_SETTLING_TIME);
- com_rslt = bmi160_get_foc_rdy(
- &focstatus);
- v_timeout_u8++;
- }
- }
- if ((com_rslt == SUCCESS) &&
- (focstatus == C_BMI160_ONE_U8X)) {
- com_rslt +=
- bmi160_get_accel_offset_compensation_zaxis(
- &v_foc_accel_offset_z_s8);
- *v_accel_offset_s8 =
- v_foc_accel_offset_z_s8;
- }
- break;
- default:
- break;
- }
- } else {
- com_rslt = ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API write fast accel offset compensation
- * it writes all axis together.To the register 0x69 bit 0 to 5
- * FOC_X_AXIS - bit 4 and 5
- * FOC_Y_AXIS - bit 2 and 3
- * FOC_Z_AXIS - bit 0 and 1
- *
- * @param v_foc_accel_x_u8: The value of accel offset x compensation
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | disable
- * 0x01 | +1g
- * 0x01 | -1g
- * 0x01 | 0g
- *
- * @param v_foc_accel_y_u8: The value of accel offset y compensation
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | disable
- * 0x01 | +1g
- * 0x01 | -1g
- * 0x01 | 0g
- *
- * @param v_foc_accel_z_u8: The value of accel offset z compensation
- * value | Behaviour
- * ----------|-------------------
- * 0x00 | disable
- * 0x01 | +1g
- * 0x01 | -1g
- * 0x01 | 0g
- *
- * @param v_accel_off_x_s8: The value of accel offset x axis
- * @param v_accel_off_y_s8: The value of accel offset y axis
- * @param v_accel_off_z_s8: The value of accel offset z axis
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_accel_foc_trigger_xyz(u8 v_foc_accel_x_u8,
- u8 v_foc_accel_y_u8, u8 v_foc_accel_z_u8, s8 *v_accel_off_x_s8,
- s8 *v_accel_off_y_s8, s8 *v_accel_off_z_s8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 focx = C_BMI160_ZERO_U8X;
- u8 focy = C_BMI160_ZERO_U8X;
- u8 focz = C_BMI160_ZERO_U8X;
- s8 v_foc_accel_offset_x_s8 = C_BMI160_ZERO_U8X;
- s8 v_foc_accel_offset_y_s8 = C_BMI160_ZERO_U8X;
- s8 v_foc_accel_offset_z_s8 = C_BMI160_ZERO_U8X;
- u8 v_status_s8 = SUCCESS;
- u8 v_timeout_u8 = C_BMI160_ZERO_U8X;
- u8 focstatus = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- v_status_s8 = bmi160_set_accel_offset_enable(
- ACCEL_OFFSET_ENABLE);
- if (v_status_s8 == SUCCESS) {
- /* foc x axis*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_X__REG,
- &focx, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- focx = BMI160_SET_BITSLICE(focx,
- BMI160_USER_FOC_ACCEL_X,
- v_foc_accel_x_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_X__REG,
- &focx, C_BMI160_ONE_U8X);
- }
- /* foc y axis*/
- com_rslt +=
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Y__REG,
- &focy, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- focy = BMI160_SET_BITSLICE(focy,
- BMI160_USER_FOC_ACCEL_Y,
- v_foc_accel_y_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Y__REG,
- &focy, C_BMI160_ONE_U8X);
- }
- /* foc z axis*/
- com_rslt +=
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Z__REG,
- &focz, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- focz = BMI160_SET_BITSLICE(focz,
- BMI160_USER_FOC_ACCEL_Z,
- v_foc_accel_z_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Z__REG,
- &focz, C_BMI160_ONE_U8X);
- }
- /* trigger the FOC need to
- write 0x03 in the register 0x7e*/
- com_rslt += bmi160_set_command_register(
- START_FOC_ACCEL_GYRO);
- com_rslt += bmi160_get_foc_rdy(
- &focstatus);
- if ((com_rslt != SUCCESS) ||
- (focstatus != C_BMI160_ONE_U8X)) {
- while ((com_rslt != SUCCESS) ||
- (focstatus != C_BMI160_ONE_U8X
- && v_timeout_u8 <
- BMI160_MAXIMUM_TIMEOUT)) {
- p_bmi160->delay_msec(
- BMI160_DELAY_SETTLING_TIME);
- com_rslt = bmi160_get_foc_rdy(
- &focstatus);
- v_timeout_u8++;
- }
- }
- if ((com_rslt == SUCCESS) &&
- (focstatus == C_BMI160_ONE_U8X)) {
- com_rslt +=
- bmi160_get_accel_offset_compensation_xaxis(
- &v_foc_accel_offset_x_s8);
- *v_accel_off_x_s8 =
- v_foc_accel_offset_x_s8;
- com_rslt +=
- bmi160_get_accel_offset_compensation_yaxis(
- &v_foc_accel_offset_y_s8);
- *v_accel_off_y_s8 =
- v_foc_accel_offset_y_s8;
- com_rslt +=
- bmi160_get_accel_offset_compensation_zaxis(
- &v_foc_accel_offset_z_s8);
- *v_accel_off_z_s8 =
- v_foc_accel_offset_z_s8;
- }
- } else {
- com_rslt = ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read gyro fast offset enable
- * from the register 0x69 bit 6
- *
- * @param v_foc_gyro_u8 : The value of gyro fast offset enable
- * value | Description
- * ----------|-------------
- * 0 | fast offset compensation disabled
- * 1 | fast offset compensation enabled
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_foc_gyro_enable(
- u8 *v_foc_gyro_u8)
- {
- /* used for return the status of bus communication */
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the gyro fast offset enable*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_GYRO_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_foc_gyro_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_GYRO_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write gyro fast offset enable
- * from the register 0x69 bit 6
- *
- * @param v_foc_gyro_u8 : The value of gyro fast offset enable
- * value | Description
- * ----------|-------------
- * 0 | fast offset compensation disabled
- * 1 | fast offset compensation enabled
- *
- * @param v_gyro_off_x_s16 : The value of gyro fast offset x axis data
- * @param v_gyro_off_y_s16 : The value of gyro fast offset y axis data
- * @param v_gyro_off_z_s16 : The value of gyro fast offset z axis data
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_foc_gyro_enable(
- u8 v_foc_gyro_u8, s16 *v_gyro_off_x_s16,
- s16 *v_gyro_off_y_s16, s16 *v_gyro_off_z_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- u8 v_status_s8 = SUCCESS;
- u8 v_timeout_u8 = C_BMI160_ZERO_U8X;
- s16 offsetx = C_BMI160_ZERO_U8X;
- s16 offsety = C_BMI160_ZERO_U8X;
- s16 offsetz = C_BMI160_ZERO_U8X;
- u8 focstatus = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- v_status_s8 = bmi160_set_gyro_offset_enable(
- GYRO_OFFSET_ENABLE);
- if (v_status_s8 == SUCCESS) {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_FOC_GYRO_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_GYRO_ENABLE,
- v_foc_gyro_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_FOC_GYRO_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- /* trigger the FOC need to write 0x03
- in the register 0x7e*/
- com_rslt += bmi160_set_command_register
- (START_FOC_ACCEL_GYRO);
- com_rslt += bmi160_get_foc_rdy(&focstatus);
- if ((com_rslt != SUCCESS) ||
- (focstatus != C_BMI160_ONE_U8X)) {
- while ((com_rslt != SUCCESS) ||
- (focstatus != C_BMI160_ONE_U8X
- && v_timeout_u8 <
- BMI160_MAXIMUM_TIMEOUT)) {
- p_bmi160->delay_msec(
- BMI160_DELAY_SETTLING_TIME);
- com_rslt = bmi160_get_foc_rdy(
- &focstatus);
- v_timeout_u8++;
- }
- }
- if ((com_rslt == SUCCESS) &&
- (focstatus == C_BMI160_ONE_U8X)) {
- com_rslt +=
- bmi160_get_gyro_offset_compensation_xaxis
- (&offsetx);
- *v_gyro_off_x_s16 = offsetx;
- com_rslt +=
- bmi160_get_gyro_offset_compensation_yaxis
- (&offsety);
- *v_gyro_off_y_s16 = offsety;
- com_rslt +=
- bmi160_get_gyro_offset_compensation_zaxis(
- &offsetz);
- *v_gyro_off_z_s16 = offsetz;
- }
- } else {
- com_rslt = ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read NVM program enable
- * from the register 0x6A bit 1
- *
- * @param v_nvm_prog_u8 : The value of NVM program enable
- * Value | Description
- * --------|-------------
- * 0 | DISABLE
- * 1 | ENABLE
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_nvm_prog_enable(
- u8 *v_nvm_prog_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read NVM program*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_CONFIG_NVM_PROG_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_nvm_prog_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_CONFIG_NVM_PROG_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write NVM program enable
- * from the register 0x6A bit 1
- *
- * @param v_nvm_prog_u8 : The value of NVM program enable
- * Value | Description
- * --------|-------------
- * 0 | DISABLE
- * 1 | ENABLE
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_nvm_prog_enable(
- u8 v_nvm_prog_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_nvm_prog_u8 < C_BMI160_TWO_U8X) {
- /* write the NVM program*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_CONFIG_NVM_PROG_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_CONFIG_NVM_PROG_ENABLE,
- v_nvm_prog_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_CONFIG_NVM_PROG_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read to configure SPI
- * Interface Mode for primary and OIS interface
- * from the register 0x6B bit 0
- *
- * @param v_spi3_u8 : The value of SPI mode selection
- * Value | Description
- * --------|-------------
- * 0 | SPI 4-wire mode
- * 1 | SPI 3-wire mode
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_spi3(
- u8 *v_spi3_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read SPI mode*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_SPI3__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_spi3_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_IF_CONFIG_SPI3);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write to configure SPI
- * Interface Mode for primary and OIS interface
- * from the register 0x6B bit 0
- *
- * @param v_spi3_u8 : The value of SPI mode selection
- * Value | Description
- * --------|-------------
- * 0 | SPI 4-wire mode
- * 1 | SPI 3-wire mode
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_spi3(
- u8 v_spi3_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_spi3_u8 < C_BMI160_TWO_U8X) {
- /* write SPI mode*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_SPI3__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_IF_CONFIG_SPI3,
- v_spi3_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_SPI3__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read I2C Watchdog timer
- * from the register 0x70 bit 1
- *
- * @param v_i2c_wdt_u8 : The value of I2C watch dog timer
- * Value | Description
- * --------|-------------
- * 0 | I2C watchdog v_timeout_u8 after 1 ms
- * 1 | I2C watchdog v_timeout_u8 after 50 ms
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_i2c_wdt_select(
- u8 *v_i2c_wdt_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read I2C watch dog timer */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_I2C_WDT_SELECT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_i2c_wdt_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_IF_CONFIG_I2C_WDT_SELECT);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write I2C Watchdog timer
- * from the register 0x70 bit 1
- *
- * @param v_i2c_wdt_u8 : The value of I2C watch dog timer
- * Value | Description
- * --------|-------------
- * 0 | I2C watchdog v_timeout_u8 after 1 ms
- * 1 | I2C watchdog v_timeout_u8 after 50 ms
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_i2c_wdt_select(
- u8 v_i2c_wdt_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_i2c_wdt_u8 < C_BMI160_TWO_U8X) {
- /* write I2C watch dog timer */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_I2C_WDT_SELECT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_IF_CONFIG_I2C_WDT_SELECT,
- v_i2c_wdt_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_I2C_WDT_SELECT__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read I2C watchdog enable
- * from the register 0x70 bit 2
- *
- * @param v_i2c_wdt_u8 : The value of I2C watchdog enable
- * Value | Description
- * --------|-------------
- * 0 | DISABLE
- * 1 | ENABLE
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_i2c_wdt_enable(
- u8 *v_i2c_wdt_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read i2c watch dog eneble */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_I2C_WDT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_i2c_wdt_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_IF_CONFIG_I2C_WDT_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write I2C watchdog enable
- * from the register 0x70 bit 2
- *
- * @param v_i2c_wdt_u8 : The value of I2C watchdog enable
- * Value | Description
- * --------|-------------
- * 0 | DISABLE
- * 1 | ENABLE
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_i2c_wdt_enable(
- u8 v_i2c_wdt_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_i2c_wdt_u8 < C_BMI160_TWO_U8X) {
- /* write i2c watch dog eneble */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_I2C_WDT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_IF_CONFIG_I2C_WDT_ENABLE,
- v_i2c_wdt_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_I2C_WDT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read I2C interface configuration(if) moe
- * from the register 0x6B bit 4 and 5
- *
- * @param v_if_mode_u8 : The value of interface configuration mode
- * Value | Description
- * --------|-------------
- * 0x00 | Primary interface:autoconfig / secondary interface:off
- * 0x01 | Primary interface:I2C / secondary interface:OIS
- * 0x02 | Primary interface:autoconfig/secondary interface:Magnetometer
- * 0x03 | Reserved
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_if_mode(
- u8 *v_if_mode_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read if mode*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_IF_MODE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_if_mode_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_IF_CONFIG_IF_MODE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write I2C interface configuration(if) moe
- * from the register 0x6B bit 4 and 5
- *
- * @param v_if_mode_u8 : The value of interface configuration mode
- * Value | Description
- * --------|-------------
- * 0x00 | Primary interface:autoconfig / secondary interface:off
- * 0x01 | Primary interface:I2C / secondary interface:OIS
- * 0x02 | Primary interface:autoconfig/secondary interface:Magnetometer
- * 0x03 | Reserved
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_if_mode(
- u8 v_if_mode_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_if_mode_u8 <= C_BMI160_FOUR_U8X) {
- /* write if mode*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_IF_MODE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_IF_CONFIG_IF_MODE,
- v_if_mode_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_IF_MODE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read gyro sleep trigger
- * from the register 0x6C bit 0 to 2
- *
- * @param v_gyro_sleep_trigger_u8 : The value of gyro sleep trigger
- * Value | Description
- * --------|-------------
- * 0x00 | nomotion: no / Not INT1 pin: no / INT2 pin: no
- * 0x01 | nomotion: no / Not INT1 pin: no / INT2 pin: yes
- * 0x02 | nomotion: no / Not INT1 pin: yes / INT2 pin: no
- * 0x03 | nomotion: no / Not INT1 pin: yes / INT2 pin: yes
- * 0x04 | nomotion: yes / Not INT1 pin: no / INT2 pin: no
- * 0x05 | anymotion: yes / Not INT1 pin: no / INT2 pin: yes
- * 0x06 | anymotion: yes / Not INT1 pin: yes / INT2 pin: no
- * 0x07 | anymotion: yes / Not INT1 pin: yes / INT2 pin: yes
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_sleep_trigger(
- u8 *v_gyro_sleep_trigger_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read gyro sleep trigger */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_SLEEP_TRIGGER__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_gyro_sleep_trigger_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_SLEEP_TRIGGER);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write gyro sleep trigger
- * from the register 0x6C bit 0 to 2
- *
- * @param v_gyro_sleep_trigger_u8 : The value of gyro sleep trigger
- * Value | Description
- * --------|-------------
- * 0x00 | nomotion: no / Not INT1 pin: no / INT2 pin: no
- * 0x01 | nomotion: no / Not INT1 pin: no / INT2 pin: yes
- * 0x02 | nomotion: no / Not INT1 pin: yes / INT2 pin: no
- * 0x03 | nomotion: no / Not INT1 pin: yes / INT2 pin: yes
- * 0x04 | nomotion: yes / Not INT1 pin: no / INT2 pin: no
- * 0x05 | anymotion: yes / Not INT1 pin: no / INT2 pin: yes
- * 0x06 | anymotion: yes / Not INT1 pin: yes / INT2 pin: no
- * 0x07 | anymotion: yes / Not INT1 pin: yes / INT2 pin: yes
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_sleep_trigger(
- u8 v_gyro_sleep_trigger_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_gyro_sleep_trigger_u8 <= C_BMI160_SEVEN_U8X) {
- /* write gyro sleep trigger */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_SLEEP_TRIGGER__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_SLEEP_TRIGGER,
- v_gyro_sleep_trigger_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_SLEEP_TRIGGER__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read gyro wakeup trigger
- * from the register 0x6C bit 3 and 4
- *
- * @param v_gyro_wakeup_trigger_u8 : The value of gyro wakeup trigger
- * Value | Description
- * --------|-------------
- * 0x00 | anymotion: no / INT1 pin: no
- * 0x01 | anymotion: no / INT1 pin: yes
- * 0x02 | anymotion: yes / INT1 pin: no
- * 0x03 | anymotion: yes / INT1 pin: yes
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_wakeup_trigger(
- u8 *v_gyro_wakeup_trigger_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read gyro wakeup trigger */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_WAKEUP_TRIGGER__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_gyro_wakeup_trigger_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_GYRO_WAKEUP_TRIGGER);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write gyro wakeup trigger
- * from the register 0x6C bit 3 and 4
- *
- * @param v_gyro_wakeup_trigger_u8 : The value of gyro wakeup trigger
- * Value | Description
- * --------|-------------
- * 0x00 | anymotion: no / INT1 pin: no
- * 0x01 | anymotion: no / INT1 pin: yes
- * 0x02 | anymotion: yes / INT1 pin: no
- * 0x03 | anymotion: yes / INT1 pin: yes
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_wakeup_trigger(
- u8 v_gyro_wakeup_trigger_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_gyro_wakeup_trigger_u8 <= C_BMI160_THREE_U8X) {
- /* write gyro wakeup trigger */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_WAKEUP_TRIGGER__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_WAKEUP_TRIGGER,
- v_gyro_wakeup_trigger_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_WAKEUP_TRIGGER__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read Target state for gyro sleep mode
- * from the register 0x6C bit 5
- *
- * @param v_gyro_sleep_state_u8 : The value of gyro sleep mode
- * Value | Description
- * --------|-------------
- * 0x00 | Sleep transition to fast wake up state
- * 0x01 | Sleep transition to suspend state
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_sleep_state(
- u8 *v_gyro_sleep_state_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read gyro sleep state*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_SLEEP_STATE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_gyro_sleep_state_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_GYRO_SLEEP_STATE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write Target state for gyro sleep mode
- * from the register 0x6C bit 5
- *
- * @param v_gyro_sleep_state_u8 : The value of gyro sleep mode
- * Value | Description
- * --------|-------------
- * 0x00 | Sleep transition to fast wake up state
- * 0x01 | Sleep transition to suspend state
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_sleep_state(
- u8 v_gyro_sleep_state_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_gyro_sleep_state_u8 < C_BMI160_TWO_U8X) {
- /* write gyro sleep state*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_SLEEP_STATE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_SLEEP_STATE,
- v_gyro_sleep_state_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_SLEEP_STATE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read gyro wakeup interrupt
- * from the register 0x6C bit 6
- *
- * @param v_gyro_wakeup_intr_u8 : The valeu of gyro wakeup interrupt
- * Value | Description
- * --------|-------------
- * 0x00 | DISABLE
- * 0x01 | ENABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_wakeup_intr(
- u8 *v_gyro_wakeup_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read gyro wakeup interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_WAKEUP_INTR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_gyro_wakeup_intr_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_GYRO_WAKEUP_INTR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write gyro wakeup interrupt
- * from the register 0x6C bit 6
- *
- * @param v_gyro_wakeup_intr_u8 : The valeu of gyro wakeup interrupt
- * Value | Description
- * --------|-------------
- * 0x00 | DISABLE
- * 0x01 | ENABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_wakeup_intr(
- u8 v_gyro_wakeup_intr_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_gyro_wakeup_intr_u8 < C_BMI160_TWO_U8X) {
- /* write gyro wakeup interrupt */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_WAKEUP_INTR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_WAKEUP_INTR,
- v_gyro_wakeup_intr_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_WAKEUP_INTR__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read accel select axis to be self-test
- *
- * @param v_accel_selftest_axis_u8 :
- * The value of accel self test axis selection
- * Value | Description
- * --------|-------------
- * 0x00 | disabled
- * 0x01 | x-axis
- * 0x02 | y-axis
- * 0x03 | z-axis
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_selftest_axis(
- u8 *v_accel_selftest_axis_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read accel self test axis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_ACCEL_SELFTEST_AXIS__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_accel_selftest_axis_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_ACCEL_SELFTEST_AXIS);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write accel select axis to be self-test
- *
- * @param v_accel_selftest_axis_u8 :
- * The value of accel self test axis selection
- * Value | Description
- * --------|-------------
- * 0x00 | disabled
- * 0x01 | x-axis
- * 0x02 | y-axis
- * 0x03 | z-axis
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_selftest_axis(
- u8 v_accel_selftest_axis_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_accel_selftest_axis_u8 <= C_BMI160_THREE_U8X) {
- /* write accel self test axis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_ACCEL_SELFTEST_AXIS__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_SELFTEST_AXIS,
- v_accel_selftest_axis_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_ACCEL_SELFTEST_AXIS__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read accel self test axis sign
- * from the register 0x6D bit 2
- *
- * @param v_accel_selftest_sign_u8: The value of accel self test axis sign
- * Value | Description
- * --------|-------------
- * 0x00 | negative
- * 0x01 | positive
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_selftest_sign(
- u8 *v_accel_selftest_sign_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read accel self test axis sign*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_ACCEL_SELFTEST_SIGN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_accel_selftest_sign_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_ACCEL_SELFTEST_SIGN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write accel self test axis sign
- * from the register 0x6D bit 2
- *
- * @param v_accel_selftest_sign_u8: The value of accel self test axis sign
- * Value | Description
- * --------|-------------
- * 0x00 | negative
- * 0x01 | positive
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_selftest_sign(
- u8 v_accel_selftest_sign_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_accel_selftest_sign_u8 < C_BMI160_TWO_U8X) {
- /* write accel self test axis sign*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_ACCEL_SELFTEST_SIGN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_SELFTEST_SIGN,
- v_accel_selftest_sign_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_ACCEL_SELFTEST_SIGN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read accel self test amplitude
- * from the register 0x6D bit 3
- * select amplitude of the selftest deflection:
- *
- * @param v_accel_selftest_amp_u8 : The value of accel self test amplitude
- * Value | Description
- * --------|-------------
- * 0x00 | LOW
- * 0x01 | HIGH
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_selftest_amp(
- u8 *v_accel_selftest_amp_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read self test amplitude*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_SELFTEST_AMP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_accel_selftest_amp_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_SELFTEST_AMP);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write accel self test amplitude
- * from the register 0x6D bit 3
- * select amplitude of the selftest deflection:
- *
- * @param v_accel_selftest_amp_u8 : The value of accel self test amplitude
- * Value | Description
- * --------|-------------
- * 0x00 | LOW
- * 0x01 | HIGH
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_selftest_amp(
- u8 v_accel_selftest_amp_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_accel_selftest_amp_u8 < C_BMI160_TWO_U8X) {
- /* write self test amplitude*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_SELFTEST_AMP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_SELFTEST_AMP,
- v_accel_selftest_amp_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_SELFTEST_AMP__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read gyro self test trigger
- *
- * @param v_gyro_selftest_start_u8: The value of gyro self test start
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_selftest_start(
- u8 *v_gyro_selftest_start_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read gyro self test start */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_SELFTEST_START__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_gyro_selftest_start_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_GYRO_SELFTEST_START);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write gyro self test trigger
- *
- * @param v_gyro_selftest_start_u8: The value of gyro self test start
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_selftest_start(
- u8 v_gyro_selftest_start_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_gyro_selftest_start_u8 < C_BMI160_TWO_U8X) {
- /* write gyro self test start */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_SELFTEST_START__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_SELFTEST_START,
- v_gyro_selftest_start_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_GYRO_SELFTEST_START__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read primary interface selection I2C or SPI
- * from the register 0x70 bit 0
- *
- * @param v_spi_enable_u8: The value of Interface selection
- * Value | Description
- * --------|-------------
- * 0x00 | I2C Enable
- * 0x01 | I2C DISBALE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_spi_enable(u8 *v_spi_enable_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read interface section*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_NV_CONFIG_SPI_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_spi_enable_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_NV_CONFIG_SPI_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write primary interface selection I2C or SPI
- * from the register 0x70 bit 0
- *
- * @param v_spi_enable_u8: The value of Interface selection
- * Value | Description
- * --------|-------------
- * 0x00 | I2C Enable
- * 0x01 | I2C DISBALE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_spi_enable(u8 v_spi_enable_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write interface section*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_NV_CONFIG_SPI_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_NV_CONFIG_SPI_ENABLE,
- v_spi_enable_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_NV_CONFIG_SPI_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read the spare zero
- * form register 0x70 bit 3
- *
- *
- * @param v_spare0_trim_u8: The value of spare zero
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_spare0_trim(u8 *v_spare0_trim_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read spare zero*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_NV_CONFIG_SPARE0__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_spare0_trim_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_NV_CONFIG_SPARE0);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write the spare zero
- * form register 0x70 bit 3
- *
- *
- * @param v_spare0_trim_u8: The value of spare zero
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_spare0_trim(u8 v_spare0_trim_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write spare zero*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_NV_CONFIG_SPARE0__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_NV_CONFIG_SPARE0,
- v_spare0_trim_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_NV_CONFIG_SPARE0__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read the NVM counter
- * form register 0x70 bit 4 to 7
- *
- *
- * @param v_nvm_counter_u8: The value of NVM counter
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_nvm_counter(u8 *v_nvm_counter_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read NVM counter*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_NV_CONFIG_NVM_COUNTER__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_nvm_counter_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_NV_CONFIG_NVM_COUNTER);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write the NVM counter
- * form register 0x70 bit 4 to 7
- *
- *
- * @param v_nvm_counter_u8: The value of NVM counter
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_nvm_counter(
- u8 v_nvm_counter_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write NVM counter*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_NV_CONFIG_NVM_COUNTER__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_NV_CONFIG_NVM_COUNTER,
- v_nvm_counter_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_NV_CONFIG_NVM_COUNTER__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read accel manual offset compensation of x axis
- * from the register 0x71 bit 0 to 7
- *
- *
- *
- * @param v_accel_off_x_s8:
- * The value of accel manual offset compensation of x axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_offset_compensation_xaxis(
- s8 *v_accel_off_x_s8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read accel manual offset compensation of x axis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_0_ACCEL_OFF_X__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_accel_off_x_s8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_0_ACCEL_OFF_X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write accel manual offset compensation of x axis
- * from the register 0x71 bit 0 to 7
- *
- *
- *
- * @param v_accel_off_x_s8:
- * The value of accel manual offset compensation of x axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_offset_compensation_xaxis(
- s8 v_accel_off_x_s8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- u8 v_status_s8 = SUCCESS;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* enable accel offset */
- v_status_s8 = bmi160_set_accel_offset_enable(
- ACCEL_OFFSET_ENABLE);
- if (v_status_s8 == SUCCESS) {
- /* write accel manual offset compensation of x axis*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_0_ACCEL_OFF_X__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(
- v_data_u8,
- BMI160_USER_OFFSET_0_ACCEL_OFF_X,
- v_accel_off_x_s8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_0_ACCEL_OFF_X__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read accel manual offset compensation of y axis
- * from the register 0x72 bit 0 to 7
- *
- *
- *
- * @param v_accel_off_y_s8:
- * The value of accel manual offset compensation of y axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_offset_compensation_yaxis(
- s8 *v_accel_off_y_s8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read accel manual offset compensation of y axis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_1_ACCEL_OFF_Y__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_accel_off_y_s8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_1_ACCEL_OFF_Y);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write accel manual offset compensation of y axis
- * from the register 0x72 bit 0 to 7
- *
- *
- *
- * @param v_accel_off_y_s8:
- * The value of accel manual offset compensation of y axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_offset_compensation_yaxis(
- s8 v_accel_off_y_s8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- u8 v_status_s8 = SUCCESS;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* enable accel offset */
- v_status_s8 = bmi160_set_accel_offset_enable(
- ACCEL_OFFSET_ENABLE);
- if (v_status_s8 == SUCCESS) {
- /* write accel manual offset compensation of y axis*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_1_ACCEL_OFF_Y__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(
- v_data_u8,
- BMI160_USER_OFFSET_1_ACCEL_OFF_Y,
- v_accel_off_y_s8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_1_ACCEL_OFF_Y__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read accel manual offset compensation of z axis
- * from the register 0x73 bit 0 to 7
- *
- *
- *
- * @param v_accel_off_z_s8:
- * The value of accel manual offset compensation of z axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_offset_compensation_zaxis(
- s8 *v_accel_off_z_s8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read accel manual offset compensation of z axis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_2_ACCEL_OFF_Z__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_accel_off_z_s8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_2_ACCEL_OFF_Z);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write accel manual offset compensation of z axis
- * from the register 0x73 bit 0 to 7
- *
- *
- *
- * @param v_accel_off_z_s8:
- * The value of accel manual offset compensation of z axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_offset_compensation_zaxis(
- s8 v_accel_off_z_s8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- u8 v_status_s8 = SUCCESS;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* enable accel offset */
- v_status_s8 = bmi160_set_accel_offset_enable(
- ACCEL_OFFSET_ENABLE);
- if (v_status_s8 == SUCCESS) {
- /* write accel manual offset
- compensation of z axis*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_2_ACCEL_OFF_Z__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_2_ACCEL_OFF_Z,
- v_accel_off_z_s8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_2_ACCEL_OFF_Z__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read gyro manual offset compensation of x axis
- * from the register 0x74 bit 0 to 7 and 0x77 bit 0 and 1
- *
- *
- *
- * @param v_gyro_off_x_s16:
- * The value of gyro manual offset compensation of x axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_offset_compensation_xaxis(
- s16 *v_gyro_off_x_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r = C_BMI160_ZERO_U8X;
- u8 v_data2_u8r = C_BMI160_ZERO_U8X;
- s16 v_data3_u8r, v_data4_u8r = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read gyro offset x*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_3_GYRO_OFF_X__REG,
- &v_data1_u8r, C_BMI160_ONE_U8X);
- v_data1_u8r = BMI160_GET_BITSLICE(v_data1_u8r,
- BMI160_USER_OFFSET_3_GYRO_OFF_X);
- com_rslt += p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_X__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- v_data2_u8r = BMI160_GET_BITSLICE(v_data2_u8r,
- BMI160_USER_OFFSET_6_GYRO_OFF_X);
- v_data3_u8r = v_data2_u8r << C_BMI160_FOURTEEN_U8X;
- v_data4_u8r = v_data1_u8r << C_BMI160_SIX_U8X;
- v_data3_u8r = v_data3_u8r | v_data4_u8r;
- *v_gyro_off_x_s16 = v_data3_u8r >> C_BMI160_SIX_U8X;
- }
- return com_rslt;
- }
- /*!
- * @brief This API write gyro manual offset compensation of x axis
- * from the register 0x74 bit 0 to 7 and 0x77 bit 0 and 1
- *
- *
- *
- * @param v_gyro_off_x_s16:
- * The value of gyro manual offset compensation of x axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_offset_compensation_xaxis(
- s16 v_gyro_off_x_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r, v_data2_u8r = C_BMI160_ZERO_U8X;
- u16 v_data3_u8r = C_BMI160_ZERO_U8X;
- u8 v_status_s8 = SUCCESS;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write gyro offset x*/
- v_status_s8 = bmi160_set_gyro_offset_enable(
- GYRO_OFFSET_ENABLE);
- if (v_status_s8 == SUCCESS) {
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_3_GYRO_OFF_X__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data1_u8r =
- ((s8) (v_gyro_off_x_s16 &
- BMI160_GYRO_MANUAL_OFFSET_0_7));
- v_data2_u8r = BMI160_SET_BITSLICE(
- v_data2_u8r,
- BMI160_USER_OFFSET_3_GYRO_OFF_X,
- v_data1_u8r);
- /* write 0x74 bit 0 to 7*/
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_3_GYRO_OFF_X__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- }
- com_rslt += p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_X__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data3_u8r =
- (u16) (v_gyro_off_x_s16 &
- BMI160_GYRO_MANUAL_OFFSET_8_9);
- v_data1_u8r = (u8)(v_data3_u8r
- >> BMI160_SHIFT_8_POSITION);
- v_data2_u8r = BMI160_SET_BITSLICE(
- v_data2_u8r,
- BMI160_USER_OFFSET_6_GYRO_OFF_X,
- v_data1_u8r);
- /* write 0x77 bit 0 and 1*/
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_X__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- }
- } else {
- return ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read gyro manual offset compensation of y axis
- * from the register 0x75 bit 0 to 7 and 0x77 bit 2 and 3
- *
- *
- *
- * @param v_gyro_off_y_s16:
- * The value of gyro manual offset compensation of y axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_offset_compensation_yaxis(
- s16 *v_gyro_off_y_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r = C_BMI160_ZERO_U8X;
- u8 v_data2_u8r = C_BMI160_ZERO_U8X;
- s16 v_data3_u8r, v_data4_u8r = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read gyro offset y*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_4_GYRO_OFF_Y__REG,
- &v_data1_u8r, C_BMI160_ONE_U8X);
- v_data1_u8r = BMI160_GET_BITSLICE(v_data1_u8r,
- BMI160_USER_OFFSET_4_GYRO_OFF_Y);
- com_rslt += p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_Y__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- v_data2_u8r = BMI160_GET_BITSLICE(v_data2_u8r,
- BMI160_USER_OFFSET_6_GYRO_OFF_Y);
- v_data3_u8r = v_data2_u8r << C_BMI160_FOURTEEN_U8X;
- v_data4_u8r = v_data1_u8r << C_BMI160_SIX_U8X;
- v_data3_u8r = v_data3_u8r | v_data4_u8r;
- *v_gyro_off_y_s16 = v_data3_u8r >> C_BMI160_SIX_U8X;
- }
- return com_rslt;
- }
- /*!
- * @brief This API write gyro manual offset compensation of y axis
- * from the register 0x75 bit 0 to 7 and 0x77 bit 2 and 3
- *
- *
- *
- * @param v_gyro_off_y_s16:
- * The value of gyro manual offset compensation of y axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_offset_compensation_yaxis(
- s16 v_gyro_off_y_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r, v_data2_u8r = C_BMI160_ZERO_U8X;
- u16 v_data3_u8r = C_BMI160_ZERO_U8X;
- u8 v_status_s8 = SUCCESS;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* enable gyro offset bit */
- v_status_s8 = bmi160_set_gyro_offset_enable(
- GYRO_OFFSET_ENABLE);
- /* write gyro offset y*/
- if (v_status_s8 == SUCCESS) {
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_4_GYRO_OFF_Y__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data1_u8r =
- ((s8) (v_gyro_off_y_s16 &
- BMI160_GYRO_MANUAL_OFFSET_0_7));
- v_data2_u8r = BMI160_SET_BITSLICE(
- v_data2_u8r,
- BMI160_USER_OFFSET_4_GYRO_OFF_Y,
- v_data1_u8r);
- /* write 0x75 bit 0 to 7*/
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_4_GYRO_OFF_Y__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- }
- com_rslt += p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_Y__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data3_u8r =
- (u16) (v_gyro_off_y_s16 &
- BMI160_GYRO_MANUAL_OFFSET_8_9);
- v_data1_u8r = (u8)(v_data3_u8r
- >> BMI160_SHIFT_8_POSITION);
- v_data2_u8r = BMI160_SET_BITSLICE(
- v_data2_u8r,
- BMI160_USER_OFFSET_6_GYRO_OFF_Y,
- v_data1_u8r);
- /* write 0x77 bit 2 and 3*/
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_Y__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- }
- } else {
- return ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read gyro manual offset compensation of z axis
- * from the register 0x76 bit 0 to 7 and 0x77 bit 4 and 5
- *
- *
- *
- * @param v_gyro_off_z_s16:
- * The value of gyro manual offset compensation of z axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_offset_compensation_zaxis(
- s16 *v_gyro_off_z_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r = C_BMI160_ZERO_U8X;
- u8 v_data2_u8r = C_BMI160_ZERO_U8X;
- s16 v_data3_u8r, v_data4_u8r = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read gyro manual offset z axis*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_5_GYRO_OFF_Z__REG,
- &v_data1_u8r, C_BMI160_ONE_U8X);
- v_data1_u8r = BMI160_GET_BITSLICE
- (v_data1_u8r,
- BMI160_USER_OFFSET_5_GYRO_OFF_Z);
- com_rslt +=
- p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_Z__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- v_data2_u8r = BMI160_GET_BITSLICE(
- v_data2_u8r,
- BMI160_USER_OFFSET_6_GYRO_OFF_Z);
- v_data3_u8r = v_data2_u8r << C_BMI160_FOURTEEN_U8X;
- v_data4_u8r = v_data1_u8r << C_BMI160_SIX_U8X;
- v_data3_u8r = v_data3_u8r | v_data4_u8r;
- *v_gyro_off_z_s16 = v_data3_u8r >> C_BMI160_SIX_U8X;
- }
- return com_rslt;
- }
- /*!
- * @brief This API write gyro manual offset compensation of z axis
- * from the register 0x76 bit 0 to 7 and 0x77 bit 4 and 5
- *
- *
- *
- * @param v_gyro_off_z_s16:
- * The value of gyro manual offset compensation of z axis
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_offset_compensation_zaxis(
- s16 v_gyro_off_z_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r, v_data2_u8r = C_BMI160_ZERO_U8X;
- u16 v_data3_u8r = C_BMI160_ZERO_U8X;
- u8 v_status_s8 = SUCCESS;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* enable gyro offset*/
- v_status_s8 = bmi160_set_gyro_offset_enable(
- GYRO_OFFSET_ENABLE);
- /* write gyro manual offset z axis*/
- if (v_status_s8 == SUCCESS) {
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_5_GYRO_OFF_Z__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data1_u8r =
- ((u8) (v_gyro_off_z_s16 &
- BMI160_GYRO_MANUAL_OFFSET_0_7));
- v_data2_u8r = BMI160_SET_BITSLICE(
- v_data2_u8r,
- BMI160_USER_OFFSET_5_GYRO_OFF_Z,
- v_data1_u8r);
- /* write 0x76 bit 0 to 7*/
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_5_GYRO_OFF_Z__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- }
- com_rslt += p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_Z__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data3_u8r =
- (u16) (v_gyro_off_z_s16 &
- BMI160_GYRO_MANUAL_OFFSET_8_9);
- v_data1_u8r = (u8)(v_data3_u8r
- >> BMI160_SHIFT_8_POSITION);
- v_data2_u8r = BMI160_SET_BITSLICE(
- v_data2_u8r,
- BMI160_USER_OFFSET_6_GYRO_OFF_Z,
- v_data1_u8r);
- /* write 0x77 bit 4 and 5*/
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_Z__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- }
- } else {
- return ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read the accel offset enable bit
- * from the register 0x77 bit 6
- *
- *
- *
- * @param v_accel_off_enable_u8: The value of accel offset enable
- * value | Description
- * ----------|--------------
- * 0x01 | ENABLE
- * 0x00 | DISABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_accel_offset_enable(
- u8 *v_accel_off_enable_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read accel offset enable */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_ACCEL_OFF_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_accel_off_enable_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_6_ACCEL_OFF_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write the accel offset enable bit
- * from the register 0x77 bit 6
- *
- *
- *
- * @param v_accel_off_enable_u8: The value of accel offset enable
- * value | Description
- * ----------|--------------
- * 0x01 | ENABLE
- * 0x00 | DISABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_accel_offset_enable(
- u8 v_accel_off_enable_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write accel offset enable */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_ACCEL_OFF_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_6_ACCEL_OFF_ENABLE,
- v_accel_off_enable_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_ACCEL_OFF_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read the accel offset enable bit
- * from the register 0x77 bit 7
- *
- *
- *
- * @param v_gyro_off_enable_u8: The value of gyro offset enable
- * value | Description
- * ----------|--------------
- * 0x01 | ENABLE
- * 0x00 | DISABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_gyro_offset_enable(
- u8 *v_gyro_off_enable_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read gyro offset*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_EN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_gyro_off_enable_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_6_GYRO_OFF_EN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write the accel offset enable bit
- * from the register 0x77 bit 7
- *
- *
- *
- * @param v_gyro_off_enable_u8: The value of gyro offset enable
- * value | Description
- * ----------|--------------
- * 0x01 | ENABLE
- * 0x00 | DISABLE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_gyro_offset_enable(
- u8 v_gyro_off_enable_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write gyro offset*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_EN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_6_GYRO_OFF_EN,
- v_gyro_off_enable_u8);
- com_rslt += p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_EN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads step counter value
- * form the register 0x78 and 0x79
- *
- *
- *
- *
- * @param v_step_cnt_s16 : The value of step counter
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_step_count(s16 *v_step_cnt_s16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* array having the step counter LSB and MSB data
- v_data_u8[0] - LSB
- v_data_u8[1] - MSB*/
- u8 a_data_u8r[ARRAY_SIZE_TWO] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read step counter */
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_STEP_COUNT_LSB__REG,
- a_data_u8r, C_BMI160_TWO_U8X);
- *v_step_cnt_s16 = (s16)
- ((((s32)((s8)a_data_u8r[MSB_ONE]))
- << BMI160_SHIFT_8_POSITION) | (a_data_u8r[LSB_ZERO]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API Reads
- * step counter configuration
- * from the register 0x7A bit 0 to 7
- * and from the register 0x7B bit 0 to 2 and 4 to 7
- *
- *
- * @param v_step_config_u16 : The value of step configuration
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_step_config(
- u16 *v_step_config_u16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r = C_BMI160_ZERO_U8X;
- u8 v_data2_u8r = C_BMI160_ZERO_U8X;
- u16 v_data3_u8r = C_BMI160_ZERO_U8X;
- /* Read the 0 to 7 bit*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_STEP_CONFIG_ZERO__REG,
- &v_data1_u8r, C_BMI160_ONE_U8X);
- /* Read the 8 to 10 bit*/
- com_rslt +=
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_STEP_CONFIG_ONE_CNF1__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- v_data2_u8r = BMI160_GET_BITSLICE(v_data2_u8r,
- BMI160_USER_STEP_CONFIG_ONE_CNF1);
- v_data3_u8r = ((u16)((((u32)
- ((u8)v_data2_u8r))
- << BMI160_SHIFT_8_POSITION) | (v_data1_u8r)));
- /* Read the 11 to 14 bit*/
- com_rslt +=
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_STEP_CONFIG_ONE_CNF2__REG,
- &v_data1_u8r, C_BMI160_ONE_U8X);
- v_data1_u8r = BMI160_GET_BITSLICE(v_data1_u8r,
- BMI160_USER_STEP_CONFIG_ONE_CNF2);
- *v_step_config_u16 = ((u16)((((u32)
- ((u8)v_data1_u8r))
- << BMI160_SHIFT_8_POSITION) | (v_data3_u8r)));
- return com_rslt;
- }
- /*!
- * @brief This API write
- * step counter configuration
- * from the register 0x7A bit 0 to 7
- * and from the register 0x7B bit 0 to 2 and 4 to 7
- *
- *
- * @param v_step_config_u16 :
- * the value of Enable step configuration
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_step_config(
- u16 v_step_config_u16)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r = C_BMI160_ZERO_U8X;
- u8 v_data2_u8r = C_BMI160_ZERO_U8X;
- u16 v_data3_u16 = C_BMI160_ZERO_U8X;
- /* write the 0 to 7 bit*/
- v_data1_u8r = (u8)(v_step_config_u16 &
- BMI160_STEP_CONFIG_0_7);
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_STEP_CONFIG_ZERO__REG,
- &v_data1_u8r, C_BMI160_ONE_U8X);
- /* write the 8 to 10 bit*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_STEP_CONFIG_ONE_CNF1__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data3_u16 = (u16) (v_step_config_u16 &
- BMI160_STEP_CONFIG_8_10);
- v_data1_u8r = (u8)(v_data3_u16 >> BMI160_SHIFT_8_POSITION);
- v_data2_u8r = BMI160_SET_BITSLICE(v_data2_u8r,
- BMI160_USER_STEP_CONFIG_ONE_CNF1, v_data1_u8r);
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_STEP_CONFIG_ONE_CNF1__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- }
- /* write the 11 to 14 bit*/
- com_rslt += p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_STEP_CONFIG_ONE_CNF2__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data3_u16 = (u16) (v_step_config_u16 &
- BMI160_STEP_CONFIG_11_14);
- v_data1_u8r = (u8)(v_data3_u16 >> BMI160_SHIFT_12_POSITION);
- v_data2_u8r = BMI160_SET_BITSLICE(v_data2_u8r,
- BMI160_USER_STEP_CONFIG_ONE_CNF2, v_data1_u8r);
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_STEP_CONFIG_ONE_CNF2__REG,
- &v_data2_u8r, C_BMI160_ONE_U8X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API read enable step counter
- * from the register 0x7B bit 3
- *
- *
- * @param v_step_counter_u8 : The value of step counter enable
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_step_counter_enable(
- u8 *v_step_counter_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the step counter */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_STEP_CONFIG_1_STEP_COUNT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_step_counter_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_STEP_CONFIG_1_STEP_COUNT_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write enable step counter
- * from the register 0x7B bit 3
- *
- *
- * @param v_step_counter_u8 : The value of step counter enable
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_step_counter_enable(u8 v_step_counter_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_step_counter_u8 < C_BMI160_THREE_U8X) {
- /* write the step counter */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_STEP_CONFIG_1_STEP_COUNT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_STEP_CONFIG_1_STEP_COUNT_ENABLE,
- v_step_counter_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_STEP_CONFIG_1_STEP_COUNT_ENABLE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API set Step counter modes
- *
- *
- * @param v_step_mode_u8 : The value of step counter mode
- * value | mode
- * ----------|-----------
- * 0 | BMI160_STEP_NORMAL_MODE
- * 1 | BMI160_STEP_SENSITIVE_MODE
- * 2 | BMI160_STEP_ROBUST_MODE
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_step_mode(u8 v_step_mode_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- switch (v_step_mode_u8) {
- case BMI160_STEP_NORMAL_MODE:
- com_rslt = bmi160_set_step_config(
- STEP_CONFIG_NORMAL);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- case BMI160_STEP_SENSITIVE_MODE:
- com_rslt = bmi160_set_step_config(
- STEP_CONFIG_SENSITIVE);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- case BMI160_STEP_ROBUST_MODE:
- com_rslt = bmi160_set_step_config(
- STEP_CONFIG_ROBUST);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This API used to trigger the signification motion
- * interrupt
- *
- *
- * @param v_significant_u8 : The value of interrupt selection
- * value | interrupt
- * ----------|-----------
- * 0 | BMI160_MAP_INTR1
- * 1 | BMI160_MAP_INTR2
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_map_significant_motion_intr(
- u8 v_significant_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_sig_motion_u8 = C_BMI160_ZERO_U8X;
- u8 v_any_motion_intr1_stat_u8 = BMI160_HEX_0_4_DATA;
- u8 v_any_motion_intr2_stat_u8 = BMI160_HEX_0_4_DATA;
- u8 v_any_motion_axis_stat_u8 = BMI160_HEX_0_7_DATA;
- /* enable the significant motion interrupt */
- com_rslt = bmi160_get_intr_significant_motion_select(&v_sig_motion_u8);
- if (v_sig_motion_u8 != C_BMI160_ONE_U8X)
- com_rslt += bmi160_set_intr_significant_motion_select(
- BMI160_HEX_0_1_DATA);
- switch (v_significant_u8) {
- case BMI160_MAP_INTR1:
- /* map the signification interrupt to any-motion interrupt1*/
- com_rslt = bmi160_write_reg(
- BMI160_USER_INTR_MAP_0_INTR1_ANY_MOTION__REG,
- &v_any_motion_intr1_stat_u8, C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_ENABLE_0_ADDR,
- &v_any_motion_axis_stat_u8, C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- case BMI160_MAP_INTR2:
- /* map the signification interrupt to any-motion interrupt2*/
- com_rslt = bmi160_write_reg(
- BMI160_USER_INTR_MAP_2_INTR2_ANY_MOTION__REG,
- &v_any_motion_intr2_stat_u8, C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_ENABLE_0_ADDR,
- &v_any_motion_axis_stat_u8, C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This API used to trigger the step detector
- * interrupt
- *
- *
- * @param v_step_detector_u8 : The value of interrupt selection
- * value | interrupt
- * ----------|-----------
- * 0 | BMI160_MAP_INTR1
- * 1 | BMI160_MAP_INTR2
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_map_step_detector_intr(
- u8 v_step_detector_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_step_det_u8 = C_BMI160_ZERO_U8X;
- u8 v_low_g_intr_u81_stat_u8 = BMI160_HEX_0_1_DATA;
- u8 v_low_g_intr_u82_stat_u8 = BMI160_HEX_0_1_DATA;
- u8 v_low_g_enable_u8 = BMI160_HEX_0_8_DATA;
- /* read the v_status_s8 of step detector interrupt*/
- com_rslt = bmi160_get_step_detector_enable(&v_step_det_u8);
- if (v_step_det_u8 != C_BMI160_ONE_U8X)
- com_rslt += bmi160_set_step_detector_enable(
- BMI160_HEX_0_1_DATA);
- switch (v_step_detector_u8) {
- case BMI160_MAP_INTR1:
- /* map the step detector interrupt
- to Low-g interrupt 1*/
- com_rslt = bmi160_write_reg(
- BMI160_USER_INTR_MAP_0_INTR1_LOW_G__REG,
- &v_low_g_intr_u81_stat_u8, C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* Enable the Low-g interrupt*/
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_ENABLE_1_LOW_G_ENABLE__REG,
- &v_low_g_enable_u8, C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- case BMI160_MAP_INTR2:
- /* map the step detector interrupt
- to Low-g interrupt 1*/
- com_rslt = bmi160_write_reg(
- BMI160_USER_INTR_MAP_2_INTR2_LOW_G__REG,
- &v_low_g_intr_u82_stat_u8, C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* Enable the Low-g interrupt*/
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_ENABLE_1_LOW_G_ENABLE__REG,
- &v_low_g_enable_u8, C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This API used to clear the step counter interrupt
- * interrupt
- *
- *
- * @param : None
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_clear_step_counter(void)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* clear the step counter*/
- com_rslt = bmi160_set_command_register(RESET_STEP_COUNTER);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- return com_rslt;
- }
- /*!
- * @brief This API writes value to the register 0x7E bit 0 to 7
- *
- *
- * @param v_command_reg_u8 : The value to write command register
- * value | Description
- * ---------|--------------------------------------------------------
- * 0x00 | Reserved
- * 0x03 | Starts fast offset calibration for the accel and gyro
- * 0x10 | Sets the PMU mode for the Accelerometer to suspend
- * 0x11 | Sets the PMU mode for the Accelerometer to normal
- * 0x12 | Sets the PMU mode for the Accelerometer Lowpower
- * 0x14 | Sets the PMU mode for the Gyroscope to suspend
- * 0x15 | Sets the PMU mode for the Gyroscope to normal
- * 0x16 | Reserved
- * 0x17 | Sets the PMU mode for the Gyroscope to fast start-up
- * 0x18 | Sets the PMU mode for the Magnetometer to suspend
- * 0x19 | Sets the PMU mode for the Magnetometer to normal
- * 0x1A | Sets the PMU mode for the Magnetometer to Lowpower
- * 0xB0 | Clears all data in the FIFO
- * 0xB1 | Resets the interrupt engine
- * 0xB2 | step_cnt_clr Clears the step counter
- * 0xB6 | Triggers a reset
- * 0x37 | See extmode_en_last
- * 0x9A | See extmode_en_last
- * 0xC0 | Enable the extended mode
- * 0xC4 | Erase NVM cell
- * 0xC8 | Load NVM cell
- * 0xF0 | Reset acceleration data path
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_command_register(u8 v_command_reg_u8)
- {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* write command register */
- com_rslt = p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_CMD_COMMANDS__REG,
- &v_command_reg_u8, C_BMI160_ONE_U8X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API read target page from the register 0x7F bit 4 and 5
- *
- * @param v_target_page_u8: The value of target page
- * value | page
- * ---------|-----------
- * 0 | User data/configure page
- * 1 | Chip level trim/test page
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_target_page(u8 *v_target_page_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the page*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_CMD_TARGET_PAGE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_target_page_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_CMD_TARGET_PAGE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write target page from the register 0x7F bit 4 and 5
- *
- * @param v_target_page_u8: The value of target page
- * value | page
- * ---------|-----------
- * 0 | User data/configure page
- * 1 | Chip level trim/test page
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_target_page(u8 v_target_page_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_target_page_u8 < C_BMI160_FOUR_U8X) {
- /* write the page*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_CMD_TARGET_PAGE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_CMD_TARGET_PAGE,
- v_target_page_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_CMD_TARGET_PAGE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read page enable from the register 0x7F bit 7
- *
- *
- *
- * @param v_page_enable_u8: The value of page enable
- * value | page
- * ---------|-----------
- * 0 | DISABLE
- * 1 | ENABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_paging_enable(u8 *v_page_enable_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the page enable */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_CMD_PAGING_EN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_page_enable_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_CMD_PAGING_EN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write page enable from the register 0x7F bit 7
- *
- *
- *
- * @param v_page_enable_u8: The value of page enable
- * value | page
- * ---------|-----------
- * 0 | DISABLE
- * 1 | ENABLE
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_paging_enable(
- u8 v_page_enable_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_page_enable_u8 < C_BMI160_TWO_U8X) {
- /* write the page enable */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_CMD_PAGING_EN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_CMD_PAGING_EN,
- v_page_enable_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_CMD_PAGING_EN__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API read
- * pull up configuration from the register 0X85 bit 4 an 5
- *
- *
- *
- * @param v_control_pullup_u8: The value of pull up register
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_pullup_configuration(
- u8 *v_control_pullup_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read pull up value */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_COM_C_TRIM_FIVE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- *v_control_pullup_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_COM_C_TRIM_FIVE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API write
- * pull up configuration from the register 0X85 bit 4 an 5
- *
- *
- *
- * @param v_control_pullup_u8: The value of pull up register
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_pullup_configuration(
- u8 v_control_pullup_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_control_pullup_u8 < C_BMI160_FOUR_U8X) {
- /* write pull up value */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_COM_C_TRIM_FIVE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- if (com_rslt == SUCCESS) {
- v_data_u8 =
- BMI160_SET_BITSLICE(v_data_u8,
- BMI160_COM_C_TRIM_FIVE,
- v_control_pullup_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC
- (p_bmi160->dev_addr,
- BMI160_COM_C_TRIM_FIVE__REG,
- &v_data_u8, C_BMI160_ONE_U8X);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This function used for reading the
- * fifo data of header mode
- *
- * @param v_fifo_length_u32 : The value of FIFO length
- *
- * @note Configure the below functions for FIFO header mode
- * @note 1. bmi160_set_fifo_down_gyro()
- * @note 2. bmi160_set_gyro_fifo_filter_data()
- * @note 3. bmi160_set_fifo_down_accel()
- * @note 4. bmi160_set_accel_fifo_filter_dat()
- * @note 5. bmi160_set_fifo_mag_enable()
- * @note 6. bmi160_set_fifo_accel_enable()
- * @note 7. bmi160_set_fifo_gyro_enable()
- * @note 8. bmi160_set_fifo_header_enable()
- * @note For interrupt configuration
- * @note 1. bmi160_set_intr_fifo_full()
- * @note 2. bmi160_set_intr_fifo_wm()
- * @note 3. bmi160_set_fifo_tag_intr2_enable()
- * @note 4. bmi160_set_fifo_tag_intr1_enable()
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_fifo_header_data(u32 v_fifo_length_u32)
- {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_accel_index_u8 = C_BMI160_ZERO_U8X;
- u8 v_gyro_index_u8 = C_BMI160_ZERO_U8X;
- u8 v_mag_index_u8 = C_BMI160_ZERO_U8X;
- s8 v_last_return_stat_s8 = C_BMI160_ZERO_U8X;
- u32 v_fifo_index_u32 = C_BMI160_ZERO_U8X;
- u16 v_mag_data_r_u16 = C_BMI160_ZERO_U8X;
- u8 v_frame_head_u8 = C_BMI160_ZERO_U8X;
- s16 v_mag_data_s16 = C_BMI160_ZERO_U8X;
- s16 v_mag_x_s16, v_mag_y_s16, v_mag_z_s16 = C_BMI160_ZERO_U8X;
- u16 v_mag_r_s16 = C_BMI160_ZERO_U8X;
- /* read fifo v_data_u8*/
- com_rslt = bmi160_fifo_data(&v_fifo_data_u8[C_BMI160_ZERO_U8X]);
- for (v_fifo_index_u32 = C_BMI160_ZERO_U8X;
- v_fifo_index_u32 < v_fifo_length_u32;) {
- v_frame_head_u8 = v_fifo_data_u8[v_fifo_index_u32];
- switch (v_frame_head_u8) {
- /* Header frame of accel */
- case FIFO_HEAD_A:
- { /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_SIX_U8X)
- > v_fifo_length_u32) {
- v_last_return_stat_s8 = FIFO_A_OVER_LEN;
- break;
- }
- /* Accel raw x v_data_u8 */
- accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X]) << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- /* Accel raw y v_data_u8 */
- accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X]) << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- /* Accel raw z v_data_u8 */
- accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X]) << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- /* index adde to 6 accel alone*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_SIX_U8X;
- v_accel_index_u8++;
- break;
- }
- /* Header frame of gyro */
- case FIFO_HEAD_G:
- { /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_SIX_U8X) >
- v_fifo_length_u32) {
- v_last_return_stat_s8 = FIFO_G_OVER_LEN;
- break;
- }
- /* Gyro raw x v_data_u8 */
- gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- /* Gyro raw y v_data_u8 */
- gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- /* Gyro raw z v_data_u8 */
- gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- /*fifo G v_data_u8 frame index + 6*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_SIX_U8X;
- v_gyro_index_u8++;
- break;
- }
- /* Header frame of mag */
- case FIFO_HEAD_M:
- { /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_EIGHT_U8X) >
- (v_fifo_length_u32)) {
- v_last_return_stat_s8 = FIFO_M_OVER_LEN;
- break;
- }
- /* Raw mag x*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X]) << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_mag_x_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Raw mag y*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- v_mag_y_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Raw mag z*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- v_mag_z_s16 = (s16)(v_mag_data_s16 >>
- C_BMI160_ONE_U8X);
- /* Raw mag r*/
- v_mag_data_r_u16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- v_mag_r_s16 = (u16) (v_mag_data_r_u16 >>
- C_BMI160_TWO_U8X);
- /* Compensated mag x v_data_u8 */
- mag_fifo[v_mag_index_u8].x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16,
- v_mag_r_s16);
- /* Compensated mag y v_data_u8 */
- mag_fifo[v_mag_index_u8].y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16,
- v_mag_r_s16);
- /* Compensated mag z v_data_u8 */
- mag_fifo[v_mag_index_u8].z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16,
- v_mag_r_s16);
- v_mag_index_u8++;
- /*fifo M v_data_u8 frame index + 8*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X;
- break;
- }
- /* Header frame of gyro and accel */
- case FIFO_HEAD_G_A:
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_SIX_U8X)
- > v_fifo_length_u32) {
- v_last_return_stat_s8 = FIFO_G_A_OVER_LEN;
- break;
- }
- /* Raw gyro x */
- gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X]) << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- /* Raw gyro y */
- gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X]) << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- /* Raw gyro z */
- gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X]) << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- /* Raw accel x */
- accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X]) << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- /* Raw accel y */
- accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINE_U8X]) << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X]));
- /* Raw accel z */
- accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ELEVEN_U8X]) << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_TEN_U8X]));
- /* Index added to 12 for gyro and accel*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_TWELVE_U8X;
- v_gyro_index_u8++;
- v_accel_index_u8++;
- break;
- /* Header frame of mag, gyro and accel */
- case FIFO_HEAD_M_G_A:
- { /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_TWENTY_U8X)
- > (v_fifo_length_u32)) {
- v_last_return_stat_s8 = FIFO_M_G_A_OVER_LEN;
- break;
- }
- /* Mag raw x v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_mag_x_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Mag raw y v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- v_mag_y_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Mag raw z v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- v_mag_z_s16 = (s16)(v_mag_data_s16 >>
- C_BMI160_ONE_U8X);
- /* Mag raw r v_data_u8 */
- v_mag_data_r_u16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- v_mag_r_s16 = (u16) (v_mag_data_r_u16 >>
- C_BMI160_TWO_U8X);
- /* Mag x compensation */
- mag_fifo[v_mag_index_u8].x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16,
- v_mag_r_s16);
- /* Mag y compensation */
- mag_fifo[v_mag_index_u8].y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16,
- v_mag_r_s16);
- /* Mag z compensation */
- mag_fifo[v_mag_index_u8].z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16,
- v_mag_r_s16);
- /* Gyro raw x v_data_u8 */
- gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X]));
- /* Gyro raw y v_data_u8 */
- gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u32 + C_BMI160_ELEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TEN_U8X]));
- /* Gyro raw z v_data_u8 */
- gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u32 + C_BMI160_THIRTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[
- v_fifo_index_u32 + C_BMI160_TWELVE_U8X]));
- /* Accel raw x v_data_u8 */
- accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u32 + C_BMI160_FIFTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOURTEEN_U8X]));
- /* Accel raw y v_data_u8 */
- accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u32 + C_BMI160_SEVENTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIXTEEN_U8X]));
- /* Accel raw z v_data_u8 */
- accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u32 + C_BMI160_NINETEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHTEEN_U8X]));
- /* Index adde to 20 for mag, gyro and accel*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_TWENTY_U8X;
- v_accel_index_u8++;
- v_mag_index_u8++;
- v_gyro_index_u8++;
- break;
- }
- /* Header frame of mag and accel */
- case FIFO_HEAD_M_A:
- { /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_FOURTEEN_U8X)
- > (v_fifo_length_u32)) {
- v_last_return_stat_s8 = FIFO_M_A_OVER_LEN;
- break;
- }
- /* mag raw x v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_mag_x_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* mag raw y v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_TWO_U8X]));
- v_mag_y_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* mag raw z v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- v_mag_z_s16 = (s16)(v_mag_data_s16 >>
- C_BMI160_ONE_U8X);
- /* mag raw r v_data_u8 */
- v_mag_data_r_u16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- v_mag_r_s16 = (u16) (v_mag_data_r_u16 >>
- C_BMI160_TWO_U8X);
- /* Mag x compensation */
- mag_fifo[v_mag_index_u8].x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16,
- v_mag_r_s16);
- /* Mag y compensation */
- mag_fifo[v_mag_index_u8].y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16,
- v_mag_r_s16);
- /* Mag z compensation */
- mag_fifo[v_mag_index_u8].z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16,
- v_mag_r_s16);
- /* Accel raw x v_data_u8 */
- accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X]));
- /* Accel raw y v_data_u8 */
- accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ELEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TEN_U8X]));
- /* Accel raw z v_data_u8 */
- accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THIRTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWELVE_U8X]));
- /*fifo AM v_data_u8 frame index + 14(8+6)*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_FOURTEEN_U8X;
- v_accel_index_u8++;
- v_mag_index_u8++;
- break;
- }
- /* Header frame of mag and gyro */
- case FIFO_HEAD_M_G:
- {
- /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_FOURTEEN_U8X)
- > v_fifo_length_u32) {
- v_last_return_stat_s8 = FIFO_M_G_OVER_LEN;
- break;
- }
- /* Mag raw x v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_mag_x_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Mag raw y v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- v_mag_y_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Mag raw z v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- v_mag_z_s16 = (s16)(v_mag_data_s16 >> C_BMI160_ONE_U8X);
- /* Mag raw r v_data_u8 */
- v_mag_data_r_u16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- v_mag_r_s16 = (u16) (v_mag_data_r_u16 >>
- C_BMI160_TWO_U8X);
- /* Mag x compensation */
- mag_fifo[v_mag_index_u8].x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16,
- v_mag_r_s16);
- /* Mag y compensation */
- mag_fifo[v_mag_index_u8].y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16,
- v_mag_r_s16);
- /* Mag z compensation */
- mag_fifo[v_mag_index_u8].z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16,
- v_mag_r_s16);
- /* Gyro raw x v_data_u8 */
- gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X]));
- /* Gyro raw y v_data_u8 */
- gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ELEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TEN_U8X]));
- /* Gyro raw z v_data_u8 */
- gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THIRTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWELVE_U8X]));
- /*fifo GM v_data_u8 frame index + 14(8+6)*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_FOURTEEN_U8X;
- v_mag_index_u8++;
- v_gyro_index_u8++;
- break;
- }
- /* Header frame of sensor time */
- case FIFO_HEAD_SENSOR_TIME:
- {
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_THREE_U8X) >
- (v_fifo_length_u32)) {
- v_last_return_stat_s8 = FIFO_SENSORTIME_RETURN;
- break;
- }
- /* Sensor time */
- V_fifo_time_U32 = (u32)
- ((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]
- << C_BMI160_SIXTEEN_U8X) |
- (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X]
- << C_BMI160_EIGHT_U8X) |
- (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_THREE_U8X;
- break;
- }
- /* Header frame of skip frame */
- case FIFO_HEAD_SKIP_FRAME:
- {
- /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- if (v_fifo_index_u32 + C_BMI160_ONE_U8X
- > v_fifo_length_u32) {
- v_last_return_stat_s8 =
- FIFO_SKIP_OVER_LEN;
- break;
- }
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- break;
- }
- /* Header frame of over read fifo v_data_u8 */
- case FIFO_HEAD_OVER_READ_LSB:
- {
- /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_ONE_U8X)
- > (v_fifo_length_u32)) {
- v_last_return_stat_s8 = FIFO_OVER_READ_RETURN;
- break;
- }
- if (v_fifo_data_u8[v_fifo_index_u32] ==
- FIFO_HEAD_OVER_READ_MSB) {
- /*fifo over read frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- break;
- } else {
- v_last_return_stat_s8 = FIFO_OVER_READ_RETURN;
- break;
- }
- }
- default:
- v_last_return_stat_s8 = C_BMI160_ONE_U8X;
- break;
- }
- if (v_last_return_stat_s8)
- break;
- }
- return com_rslt;
- }
- //add by lwy
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_accel_gyro_fifo_data(u8 *r_v_accel_index_u8, struct bmi160_accel_t **r_accel_fifo, u8 *r_v_gyro_index_u8,struct bmi160_gyro_t **r_gyro_fifo)
- {
- u32 v_fifo_length_u32 = FIFO_FRAME;
-
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_accel_index_u8 = C_BMI160_ZERO_U8X;
- u8 v_gyro_index_u8 = C_BMI160_ZERO_U8X;
- u8 v_mag_index_u8 = C_BMI160_ZERO_U8X;
- s8 v_last_return_stat_s8 = C_BMI160_ZERO_U8X;
- u32 v_fifo_index_u32 = C_BMI160_ZERO_U8X;
- u16 v_mag_data_r_u16 = C_BMI160_ZERO_U8X;
- u8 v_frame_head_u8 = C_BMI160_ZERO_U8X;
- s16 v_mag_data_s16 = C_BMI160_ZERO_U8X;
- s16 v_mag_x_s16, v_mag_y_s16, v_mag_z_s16 = C_BMI160_ZERO_U8X;
- u16 v_mag_r_s16 = C_BMI160_ZERO_U8X;
- /* read fifo v_data_u8*/
- com_rslt = bmi160_fifo_data_get_set_integration(&v_fifo_data_u8[C_BMI160_ZERO_U8X],&v_fifo_length_u32);
- for (v_fifo_index_u32 = C_BMI160_ZERO_U8X;
- v_fifo_index_u32 < v_fifo_length_u32;) {
- v_frame_head_u8 = v_fifo_data_u8[v_fifo_index_u32];
- switch (v_frame_head_u8) {
- /* Header frame of accel */
- case FIFO_HEAD_A:
- { /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_SIX_U8X)
- > v_fifo_length_u32) {
- v_last_return_stat_s8 = FIFO_A_OVER_LEN;
- break;
- }
- /* Accel raw x v_data_u8 */
- accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X]) << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- /* Accel raw y v_data_u8 */
- accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X]) << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- /* Accel raw z v_data_u8 */
- accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X]) << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- /* index adde to 6 accel alone*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_SIX_U8X;
- v_accel_index_u8++;
- //add by lwy
- static int16_t acc_int16t[3];
- acc_int16t[0] = accel_fifo[v_accel_index_u8].x;
- acc_int16t[1] = accel_fifo[v_accel_index_u8].y;
- acc_int16t[2] = -accel_fifo[v_accel_index_u8].z;
- extern void detect_step_by_acc(int16_t *acc);
- detect_step_by_acc(acc_int16t);
- break;
- }
- /* Header frame of gyro */
- case FIFO_HEAD_G:
- { /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_SIX_U8X) >
- v_fifo_length_u32) {
- v_last_return_stat_s8 = FIFO_G_OVER_LEN;
- break;
- }
- /* Gyro raw x v_data_u8 */
- gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- /* Gyro raw y v_data_u8 */
- gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- /* Gyro raw z v_data_u8 */
- gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- /*fifo G v_data_u8 frame index + 6*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_SIX_U8X;
- v_gyro_index_u8++;
- break;
- }
- /* Header frame of mag */
- case FIFO_HEAD_M:
- { /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_EIGHT_U8X) >
- (v_fifo_length_u32)) {
- v_last_return_stat_s8 = FIFO_M_OVER_LEN;
- break;
- }
- /* Raw mag x*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X]) << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_mag_x_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Raw mag y*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- v_mag_y_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Raw mag z*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- | (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- v_mag_z_s16 = (s16)(v_mag_data_s16 >>
- C_BMI160_ONE_U8X);
- /* Raw mag r*/
- v_mag_data_r_u16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- v_mag_r_s16 = (u16) (v_mag_data_r_u16 >>
- C_BMI160_TWO_U8X);
- /* Compensated mag x v_data_u8 */
- mag_fifo[v_mag_index_u8].x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16,
- v_mag_r_s16);
- /* Compensated mag y v_data_u8 */
- mag_fifo[v_mag_index_u8].y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16,
- v_mag_r_s16);
- /* Compensated mag z v_data_u8 */
- mag_fifo[v_mag_index_u8].z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16,
- v_mag_r_s16);
- v_mag_index_u8++;
- /*fifo M v_data_u8 frame index + 8*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X;
- break;
- }
- /* Header frame of gyro and accel */
- case FIFO_HEAD_G_A:
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_SIX_U8X)
- > v_fifo_length_u32) {
- v_last_return_stat_s8 = FIFO_G_A_OVER_LEN;
- break;
- }
- /* Raw gyro x */
- gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X]) << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- /* Raw gyro y */
- gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X]) << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- /* Raw gyro z */
- gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X]) << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- /* Raw accel x */
- accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X]) << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- /* Raw accel y */
- accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINE_U8X]) << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X]));
- /* Raw accel z */
- accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ELEVEN_U8X]) << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_TEN_U8X]));
- /* Index added to 12 for gyro and accel*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_TWELVE_U8X;
- v_gyro_index_u8++;
- v_accel_index_u8++;
- break;
- /* Header frame of mag, gyro and accel */
- case FIFO_HEAD_M_G_A:
- { /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_TWENTY_U8X)
- > (v_fifo_length_u32)) {
- v_last_return_stat_s8 = FIFO_M_G_A_OVER_LEN;
- break;
- }
- /* Mag raw x v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_mag_x_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Mag raw y v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- v_mag_y_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Mag raw z v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- v_mag_z_s16 = (s16)(v_mag_data_s16 >>
- C_BMI160_ONE_U8X);
- /* Mag raw r v_data_u8 */
- v_mag_data_r_u16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- v_mag_r_s16 = (u16) (v_mag_data_r_u16 >>
- C_BMI160_TWO_U8X);
- /* Mag x compensation */
- mag_fifo[v_mag_index_u8].x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16,
- v_mag_r_s16);
- /* Mag y compensation */
- mag_fifo[v_mag_index_u8].y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16,
- v_mag_r_s16);
- /* Mag z compensation */
- mag_fifo[v_mag_index_u8].z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16,
- v_mag_r_s16);
- /* Gyro raw x v_data_u8 */
- gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X]));
- /* Gyro raw y v_data_u8 */
- gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u32 + C_BMI160_ELEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TEN_U8X]));
- /* Gyro raw z v_data_u8 */
- gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u32 + C_BMI160_THIRTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[
- v_fifo_index_u32 + C_BMI160_TWELVE_U8X]));
- /* Accel raw x v_data_u8 */
- accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u32 + C_BMI160_FIFTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOURTEEN_U8X]));
- /* Accel raw y v_data_u8 */
- accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u32 + C_BMI160_SEVENTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIXTEEN_U8X]));
- /* Accel raw z v_data_u8 */
- accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u32 + C_BMI160_NINETEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHTEEN_U8X]));
- /* Index adde to 20 for mag, gyro and accel*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_TWENTY_U8X;
- v_accel_index_u8++;
- v_mag_index_u8++;
- v_gyro_index_u8++;
- break;
- }
- /* Header frame of mag and accel */
- case FIFO_HEAD_M_A:
- { /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_FOURTEEN_U8X)
- > (v_fifo_length_u32)) {
- v_last_return_stat_s8 = FIFO_M_A_OVER_LEN;
- break;
- }
- /* mag raw x v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_mag_x_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* mag raw y v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_TWO_U8X]));
- v_mag_y_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* mag raw z v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- v_mag_z_s16 = (s16)(v_mag_data_s16 >>
- C_BMI160_ONE_U8X);
- /* mag raw r v_data_u8 */
- v_mag_data_r_u16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- v_mag_r_s16 = (u16) (v_mag_data_r_u16 >>
- C_BMI160_TWO_U8X);
- /* Mag x compensation */
- mag_fifo[v_mag_index_u8].x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16,
- v_mag_r_s16);
- /* Mag y compensation */
- mag_fifo[v_mag_index_u8].y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16,
- v_mag_r_s16);
- /* Mag z compensation */
- mag_fifo[v_mag_index_u8].z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16,
- v_mag_r_s16);
- /* Accel raw x v_data_u8 */
- accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X]));
- /* Accel raw y v_data_u8 */
- accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ELEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TEN_U8X]));
- /* Accel raw z v_data_u8 */
- accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THIRTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWELVE_U8X]));
- /*fifo AM v_data_u8 frame index + 14(8+6)*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_FOURTEEN_U8X;
- v_accel_index_u8++;
- v_mag_index_u8++;
- break;
- }
- /* Header frame of mag and gyro */
- case FIFO_HEAD_M_G:
- {
- /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_FOURTEEN_U8X)
- > v_fifo_length_u32) {
- v_last_return_stat_s8 = FIFO_M_G_OVER_LEN;
- break;
- }
- /* Mag raw x v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_mag_x_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Mag raw y v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- v_mag_y_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Mag raw z v_data_u8 */
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- v_mag_z_s16 = (s16)(v_mag_data_s16 >> C_BMI160_ONE_U8X);
- /* Mag raw r v_data_u8 */
- v_mag_data_r_u16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- v_mag_r_s16 = (u16) (v_mag_data_r_u16 >>
- C_BMI160_TWO_U8X);
- /* Mag x compensation */
- mag_fifo[v_mag_index_u8].x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16,
- v_mag_r_s16);
- /* Mag y compensation */
- mag_fifo[v_mag_index_u8].y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16,
- v_mag_r_s16);
- /* Mag z compensation */
- mag_fifo[v_mag_index_u8].z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16,
- v_mag_r_s16);
- /* Gyro raw x v_data_u8 */
- gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X]));
- /* Gyro raw y v_data_u8 */
- gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ELEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TEN_U8X]));
- /* Gyro raw z v_data_u8 */
- gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THIRTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWELVE_U8X]));
- /*fifo GM v_data_u8 frame index + 14(8+6)*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_FOURTEEN_U8X;
- v_mag_index_u8++;
- v_gyro_index_u8++;
- break;
- }
- /* Header frame of sensor time */
- case FIFO_HEAD_SENSOR_TIME:
- {
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_THREE_U8X) >
- (v_fifo_length_u32)) {
- v_last_return_stat_s8 = FIFO_SENSORTIME_RETURN;
- break;
- }
- /* Sensor time */
- V_fifo_time_U32 = (u32)
- ((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]
- << C_BMI160_SIXTEEN_U8X) |
- (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X]
- << C_BMI160_EIGHT_U8X) |
- (v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_THREE_U8X;
- break;
- }
- /* Header frame of skip frame */
- case FIFO_HEAD_SKIP_FRAME:
- {
- /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- if (v_fifo_index_u32 + C_BMI160_ONE_U8X
- > v_fifo_length_u32) {
- v_last_return_stat_s8 =
- FIFO_SKIP_OVER_LEN;
- break;
- }
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- break;
- }
- /* Header frame of over read fifo v_data_u8 */
- case FIFO_HEAD_OVER_READ_LSB:
- {
- /*fifo v_data_u8 frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- if ((v_fifo_index_u32 + C_BMI160_ONE_U8X)
- > (v_fifo_length_u32)) {
- v_last_return_stat_s8 = FIFO_OVER_READ_RETURN;
- break;
- }
- if (v_fifo_data_u8[v_fifo_index_u32] ==
- FIFO_HEAD_OVER_READ_MSB) {
- /*fifo over read frame index + 1*/
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_ONE_U8X;
- break;
- } else {
- v_last_return_stat_s8 = FIFO_OVER_READ_RETURN;
- break;
- }
- }
- default:
- v_last_return_stat_s8 = C_BMI160_ONE_U8X;
- break;
- }
- if (v_last_return_stat_s8)
- break;
- }
-
- if(r_v_accel_index_u8 != 0)
- *r_v_accel_index_u8 = v_accel_index_u8;
-
- if(r_accel_fifo != 0)
- *r_accel_fifo = accel_fifo;
- if(r_v_gyro_index_u8 != 0)
- *r_v_gyro_index_u8 = v_gyro_index_u8;
- if(r_gyro_fifo != 0)
- *r_gyro_fifo = gyro_fifo;
-
- // u32 i;
- // for(i=0;i<v_accel_index_u8;i++)
- // {
- //// SEGGER_RTT_printf(0,"err:%d a[%d].x:%d a[%d].y:%d a[%d].z:%d\r\n",com_rslt,i,accel_fifo[i].x,i,accel_fifo[i].y,i,accel_fifo[i].z);
- // SEGGER_RTT_printf(0,"err:%d a[%d].x:%d a[%d].y:%d a[%d].z:%d\r\n",com_rslt,i,r_accel_fifo[i].x,i,r_accel_fifo[i].y,i,r_accel_fifo[i].z);
- // }
- return com_rslt;
- }
- /*!
- * @brief This function used for reading the
- * fifo data of header less mode
- *
- * @param v_fifo_length_u32 : The value of FIFO length
- *
- *
- * @note Configure the below functions for FIFO header less mode
- * @note 1. bmi160_set_fifo_down_gyro
- * @note 2. bmi160_set_gyro_fifo_filter_data
- * @note 3. bmi160_set_fifo_down_accel
- * @note 4. bmi160_set_accel_fifo_filter_dat
- * @note 5. bmi160_set_fifo_mag_enable
- * @note 6. bmi160_set_fifo_accel_enable
- * @note 7. bmi160_set_fifo_gyro_enable
- * @note For interrupt configuration
- * @note 1. bmi160_set_intr_fifo_full
- * @note 2. bmi160_set_intr_fifo_wm
- * @note 3. bmi160_set_fifo_tag_intr2_enable
- * @note 4. bmi160_set_fifo_tag_intr1_enable
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_fifo_headerless_mode(
- u32 v_fifo_length_u32) {
- u8 mag_en = C_BMI160_ZERO_U8X;
- u8 accel_en = C_BMI160_ZERO_U8X;
- u8 gyro_en = C_BMI160_ZERO_U8X;
- u32 v_fifo_index_u32 = C_BMI160_ZERO_U8X;
- s16 v_mag_data_s16 = C_BMI160_ZERO_U8X;
- u16 v_mag_data_r_u16 = C_BMI160_ZERO_U8X;
- u16 v_mag_r_s16 = C_BMI160_ZERO_U8X;
- s16 v_mag_x_s16, v_mag_y_s16, v_mag_z_s16 = C_BMI160_ZERO_U8X;
- u8 v_accel_index_u8 = C_BMI160_ZERO_U8X;
- u8 v_gyro_index_u8 = C_BMI160_ZERO_U8X;
- u8 v_mag_index_u8 = C_BMI160_ZERO_U8X;
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* disable the header data */
- com_rslt = bmi160_set_fifo_header_enable(C_BMI160_ZERO_U8X);
- /* read the mag enable status*/
- com_rslt += bmi160_get_fifo_mag_enable(&mag_en);
- /* read the accel enable status*/
- com_rslt += bmi160_get_fifo_accel_enable(&accel_en);
- /* read the gyro enable status*/
- com_rslt += bmi160_get_fifo_gyro_enable(&gyro_en);
- /* read the fifo data of 1024 bytes*/
- com_rslt += bmi160_fifo_data(&v_fifo_data_u8[C_BMI160_ZERO_U8X]);
- /* loop for executing the different conditions */
- for (v_fifo_index_u32 = C_BMI160_ZERO_U8X;
- v_fifo_index_u32 < v_fifo_length_u32;) {
- /* condition for mag, gyro and accel enable*/
- if ((mag_en == C_BMI160_ONE_U8X) &&
- (gyro_en == C_BMI160_ONE_U8X)
- && (accel_en == C_BMI160_ONE_U8X)) {
- /* Raw mag x*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_mag_x_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Raw mag y*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- v_mag_y_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Raw mag z*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- v_mag_z_s16 = (s16)(v_mag_data_s16 >>
- C_BMI160_ONE_U8X);
- /* Raw mag r*/
- v_mag_data_r_u16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- v_mag_r_s16 = (u16) (v_mag_data_r_u16 >>
- C_BMI160_TWO_U8X);
- /* Compensated mag x v_data_u8 */
- mag_fifo[v_mag_index_u8].x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16, v_mag_r_s16);
- /* Compensated mag y v_data_u8 */
- mag_fifo[v_mag_index_u8].y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16, v_mag_r_s16);
- /* Compensated mag z v_data_u8 */
- mag_fifo[v_mag_index_u8].z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16, v_mag_r_s16);
- /* Gyro raw x v_data_u8 */
- gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X]));
- /* Gyro raw y v_data_u8 */
- gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ELEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TEN_U8X]));
- /* Gyro raw z v_data_u8 */
- gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THIRTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWELVE_U8X]));
- /* Accel raw x v_data_u8 */
- accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIFTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOURTEEN_U8X]));
- /* Accel raw y v_data_u8 */
- accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVENTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIXTEEN_U8X]));
- /* Accel raw z v_data_u8 */
- accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINETEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHTEEN_U8X]));
- v_accel_index_u8++;
- v_mag_index_u8++;
- v_gyro_index_u8++;
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_TWENTY_U8X;
- }
- /* condition for mag and gyro enable*/
- else if ((mag_en == C_BMI160_ONE_U8X) &&
- (gyro_en == C_BMI160_ONE_U8X)
- && (accel_en == C_BMI160_ZERO_U8X)) {
- /* Raw mag x*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_mag_x_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Raw mag y*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- v_mag_y_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Raw mag z*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- v_mag_z_s16 = (s16)(v_mag_data_s16 >>
- C_BMI160_ONE_U8X);
- /* Raw mag r*/
- v_mag_data_r_u16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- v_mag_r_s16 = (u16) (v_mag_data_r_u16 >>
- C_BMI160_TWO_U8X);
- /* Compensated mag x v_data_u8 */
- mag_fifo[v_mag_index_u8].x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16, v_mag_r_s16);
- /* Compensated mag y v_data_u8 */
- mag_fifo[v_mag_index_u8].y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16, v_mag_r_s16);
- /* Compensated mag z v_data_u8 */
- mag_fifo[v_mag_index_u8].z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16, v_mag_r_s16);
- /* Gyro raw x v_data_u8 */
- gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X]));
- /* Gyro raw y v_data_u8 */
- gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ELEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TEN_U8X]));
- /* Gyro raw z v_data_u8 */
- gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THIRTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWELVE_U8X]));
- v_gyro_index_u8++;
- v_mag_index_u8++;
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_FOURTEEN_U8X;
- }
- /* condition for mag and accel enable*/
- else if ((mag_en == C_BMI160_ONE_U8X) &&
- (accel_en == C_BMI160_ONE_U8X)
- && (gyro_en == C_BMI160_ZERO_U8X)) {
- /* Raw mag x*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- v_mag_x_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Raw mag y*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- v_mag_y_s16 = (s16) (v_mag_data_s16 >>
- C_BMI160_THREE_U8X);
- /* Raw mag z*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- v_mag_z_s16 = (s16)(v_mag_data_s16 >>
- C_BMI160_ONE_U8X);
- /* Raw mag r*/
- v_mag_data_r_u16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- v_mag_r_s16 = (u16) (v_mag_data_r_u16 >>
- C_BMI160_TWO_U8X);
- /* Compensated mag x v_data_u8 */
- mag_fifo[v_mag_index_u8].x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16, v_mag_r_s16);
- /* Compensated mag y v_data_u8 */
- mag_fifo[v_mag_index_u8].y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16, v_mag_r_s16);
- /* Compensated mag z v_data_u8 */
- mag_fifo[v_mag_index_u8].z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16, v_mag_r_s16);
- /* Accel raw x v_data_u8 */
- accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X]));
- /* Accel raw y v_data_u8 */
- accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ELEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TEN_U8X]));
- /* Accel raw z v_data_u8 */
- accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THIRTEEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWELVE_U8X]));
- v_accel_index_u8++;
- v_mag_index_u8++;
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_FOURTEEN_U8X;
- }
- /* condition for gyro and accel enable*/
- else if ((gyro_en == C_BMI160_ONE_U8X) &&
- (accel_en == C_BMI160_ONE_U8X)
- && (mag_en == C_BMI160_ZERO_U8X)) {
- /* Gyro raw x v_data_u8 */
- gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ZERO_U8X]));
- /* Gyro raw y v_data_u8 */
- gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TWO_U8X]));
- /* Gyro raw z v_data_u8 */
- gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_FOUR_U8X]));
- /* Accel raw x v_data_u8 */
- accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_SIX_U8X]));
- /* Accel raw y v_data_u8 */
- accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_NINE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_EIGHT_U8X]));
- /* Accel raw z v_data_u8 */
- accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_ELEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 +
- C_BMI160_TEN_U8X]));
- v_accel_index_u8++;
- v_gyro_index_u8++;
- v_fifo_index_u32 = v_fifo_index_u32 +
- C_BMI160_TWELVE_U8X;
- }
- /* condition for gyro enable*/
- else if ((gyro_en == C_BMI160_ONE_U8X) &&
- (accel_en == C_BMI160_ZERO_U8X)
- && (mag_en == C_BMI160_ZERO_U8X)) {
- /* Gyro raw x v_data_u8 */
- gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_ZERO_U8X]));
- /* Gyro raw y v_data_u8 */
- gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_TWO_U8X]));
- /* Gyro raw z v_data_u8 */
- gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_FOUR_U8X]));
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_SIX_U8X;
- v_gyro_index_u8++;
- }
- /* condition for accel enable*/
- else if ((gyro_en == C_BMI160_ZERO_U8X) &&
- (accel_en == C_BMI160_ONE_U8X)
- && (mag_en == C_BMI160_ZERO_U8X)) {
- /* Accel raw x v_data_u8 */
- accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_ZERO_U8X]));
- /* Accel raw y v_data_u8 */
- accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_TWO_U8X]));
- /* Accel raw z v_data_u8 */
- accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_FOUR_U8X]));
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_SIX_U8X;
- v_accel_index_u8++;
- }
- /* condition for mag enable*/
- else if ((gyro_en == C_BMI160_ZERO_U8X) &&
- (accel_en == C_BMI160_ZERO_U8X)
- && (mag_en == C_BMI160_ONE_U8X)) {
- /* Raw mag x*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_ONE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_ZERO_U8X]));
- v_mag_x_s16 = (s16) (v_mag_data_s16 >> C_BMI160_THREE_U8X);
- /* Raw mag y*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_THREE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_TWO_U8X]));
- v_mag_y_s16 = (s16) (v_mag_data_s16 >> C_BMI160_THREE_U8X);
- /* Raw mag z*/
- v_mag_data_s16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_FIVE_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_FOUR_U8X]));
- v_mag_z_s16 = (s16)(v_mag_data_s16 >> C_BMI160_ONE_U8X);
- /* Raw mag r*/
- v_mag_data_r_u16 =
- (s16)(((v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_SEVEN_U8X])
- << C_BMI160_EIGHT_U8X)
- |(v_fifo_data_u8[v_fifo_index_u32 + C_BMI160_SIX_U8X]));
- v_mag_r_s16 = (u16) (v_mag_data_r_u16 >> C_BMI160_TWO_U8X);
- /* Compensated mag x v_data_u8 */
- mag_fifo[v_mag_index_u8].x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16, v_mag_r_s16);
- /* Compensated mag y v_data_u8 */
- mag_fifo[v_mag_index_u8].y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16, v_mag_r_s16);
- /* Compensated mag z v_data_u8 */
- mag_fifo[v_mag_index_u8].z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16, v_mag_r_s16);
- v_fifo_index_u32 = v_fifo_index_u32 + C_BMI160_EIGHT_U8X;
- v_mag_index_u8++;
- }
- /* condition for fifo over read enable*/
- if (v_fifo_data_u8[v_fifo_index_u32] == FIFO_CONFIG_CHECK1 &&
- v_fifo_data_u8[v_fifo_index_u32+C_BMI160_ONE_U8X] ==
- FIFO_CONFIG_CHECK2 &&
- v_fifo_data_u8[v_fifo_index_u32+C_BMI160_TWO_U8X] ==
- FIFO_CONFIG_CHECK1 &&
- v_fifo_data_u8[v_fifo_index_u32+C_BMI160_THREE_U8X] ==
- FIFO_CONFIG_CHECK2) {
- return FIFO_OVER_READ_RETURN;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This function used for read the compensated value of mag
- * Before start reading the mag compensated data's
- * make sure the following two points are addressed
- * @note
- * 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note
- * 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bmm150_mag_compensate_xyz(
- struct bmi160_mag_xyz_s32_t *mag_comp_xyz)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- struct bmi160_mag_xyzr_t mag_xyzr;
- com_rslt = bmi160_read_mag_xyzr(&mag_xyzr);
- /* Compensation for X axis */
- mag_comp_xyz->x = bmi160_bmm150_mag_compensate_X(
- mag_xyzr.x, mag_xyzr.r);
- /* Compensation for Y axis */
- mag_comp_xyz->y = bmi160_bmm150_mag_compensate_Y(
- mag_xyzr.y, mag_xyzr.r);
- /* Compensation for Z axis */
- mag_comp_xyz->z = bmi160_bmm150_mag_compensate_Z(
- mag_xyzr.z, mag_xyzr.r);
- return com_rslt;
- }
- /*!
- * @brief This API used to get the compensated BMM150-X data
- * the out put of X as s32
- * Before start reading the mag compensated X data
- * make sure the following two points are addressed
- * @note
- * 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note
- * 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- *
- *
- * @param v_mag_data_x_s16 : The value of mag raw X data
- * @param v_data_r_u16 : The value of mag R data
- *
- * @return results of compensated X data value output as s32
- *
- */
- s32 bmi160_bmm150_mag_compensate_X(s16 v_mag_data_x_s16, u16 v_data_r_u16)
- {
- s32 inter_retval = C_BMI160_ZERO_U8X;
- /* no overflow */
- if (v_mag_data_x_s16 != BMI160_MAG_FLIP_OVERFLOW_ADCVAL) {
- if ((v_data_r_u16 != C_BMI160_ZERO_U8X)
- && (mag_trim.dig_xyz1 != C_BMI160_ZERO_U8X)) {
- inter_retval = ((s32)(((u16)
- ((((s32)mag_trim.dig_xyz1)
- << BMI160_SHIFT_14_POSITION)/
- (v_data_r_u16 != C_BMI160_ZERO_U8X ?
- v_data_r_u16 : mag_trim.dig_xyz1))) -
- ((u16)BMM150_CALIB_HEX_FOUR_THOUSAND)));
- } else {
- inter_retval = BMI160_MAG_OVERFLOW_OUTPUT;
- return inter_retval;
- }
- inter_retval = ((s32)((((s32)v_mag_data_x_s16) *
- ((((((((s32)mag_trim.dig_xy2) *
- ((((s32)inter_retval) *
- ((s32)inter_retval))
- >> BMI160_SHIFT_7_POSITION)) +
- (((s32)inter_retval) *
- ((s32)(((s16)mag_trim.dig_xy1)
- << BMI160_SHIFT_7_POSITION))))
- >> BMI160_SHIFT_9_POSITION) +
- ((s32)BMM150_CALIB_HEX_LACKS)) *
- ((s32)(((s16)mag_trim.dig_x2) +
- ((s16)BMM150_CALIB_HEX_A_ZERO))))
- >> BMI160_SHIFT_12_POSITION))
- >> BMI160_SHIFT_13_POSITION)) +
- (((s16)mag_trim.dig_x1)
- << BMI160_SHIFT_3_POSITION);
- /* check the overflow output */
- if (inter_retval == (s32)BMI160_MAG_OVERFLOW_OUTPUT)
- inter_retval = BMI160_MAG_OVERFLOW_OUTPUT_S32;
- } else {
- /* overflow */
- inter_retval = BMI160_MAG_OVERFLOW_OUTPUT;
- }
- return inter_retval;
- }
- /*!
- * @brief This API used to get the compensated BMM150-Y data
- * the out put of Y as s32
- * Before start reading the mag compensated Y data
- * make sure the following two points are addressed
- * @note
- * 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note
- * 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- *
- *
- * @param v_mag_data_y_s16 : The value of mag raw Y data
- * @param v_data_r_u16 : The value of mag R data
- *
- * @return results of compensated Y data value output as s32
- */
- s32 bmi160_bmm150_mag_compensate_Y(s16 v_mag_data_y_s16, u16 v_data_r_u16)
- {
- s32 inter_retval = C_BMI160_ZERO_U8X;
- /* no overflow */
- if (v_mag_data_y_s16 != BMI160_MAG_FLIP_OVERFLOW_ADCVAL) {
- if ((v_data_r_u16 != C_BMI160_ZERO_U8X)
- && (mag_trim.dig_xyz1 != C_BMI160_ZERO_U8X)) {
- inter_retval = ((s32)(((u16)(((
- (s32)mag_trim.dig_xyz1) << BMI160_SHIFT_14_POSITION)/
- (v_data_r_u16 != C_BMI160_ZERO_U8X ?
- v_data_r_u16 : mag_trim.dig_xyz1))) -
- ((u16)BMM150_CALIB_HEX_FOUR_THOUSAND)));
- } else {
- inter_retval = BMI160_MAG_OVERFLOW_OUTPUT;
- return inter_retval;
- }
- inter_retval = ((s32)((((s32)v_mag_data_y_s16) * ((((((((s32)
- mag_trim.dig_xy2) * ((((s32) inter_retval) *
- ((s32)inter_retval)) >> BMI160_SHIFT_7_POSITION))
- + (((s32)inter_retval) *
- ((s32)(((s16)mag_trim.dig_xy1)
- << BMI160_SHIFT_7_POSITION))))
- >> BMI160_SHIFT_9_POSITION) +
- ((s32)BMM150_CALIB_HEX_LACKS))
- * ((s32)(((s16)mag_trim.dig_y2)
- + ((s16)BMM150_CALIB_HEX_A_ZERO))))
- >> BMI160_SHIFT_12_POSITION))
- >> BMI160_SHIFT_13_POSITION)) +
- (((s16)mag_trim.dig_y1) << BMI160_SHIFT_3_POSITION);
- /* check the overflow output */
- if (inter_retval == (s32)BMI160_MAG_OVERFLOW_OUTPUT)
- inter_retval = BMI160_MAG_OVERFLOW_OUTPUT_S32;
- } else {
- /* overflow */
- inter_retval = BMI160_MAG_OVERFLOW_OUTPUT;
- }
- return inter_retval;
- }
- /*!
- * @brief This API used to get the compensated BMM150-Z data
- * the out put of Z as s32
- * Before start reading the mag compensated Z data
- * make sure the following two points are addressed
- * @note
- * 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note
- * 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- *
- *
- * @param v_mag_data_z_s16 : The value of mag raw Z data
- * @param v_data_r_u16 : The value of mag R data
- *
- * @return results of compensated Z data value output as s32
- */
- s32 bmi160_bmm150_mag_compensate_Z(s16 v_mag_data_z_s16, u16 v_data_r_u16)
- {
- s32 retval = C_BMI160_ZERO_U8X;
- if (v_mag_data_z_s16 != BMI160_MAG_HALL_OVERFLOW_ADCVAL) {
- if ((v_data_r_u16 != C_BMI160_ZERO_U8X)
- && (mag_trim.dig_z2 != C_BMI160_ZERO_U8X)
- && (mag_trim.dig_z1 != C_BMI160_ZERO_U8X)) {
- retval = (((((s32)(v_mag_data_z_s16 - mag_trim.dig_z4))
- << BMI160_SHIFT_15_POSITION) -
- ((((s32)mag_trim.dig_z3) *
- ((s32)(((s16)v_data_r_u16) -
- ((s16)mag_trim.dig_xyz1))))
- >> BMI160_SHIFT_2_POSITION))/
- (mag_trim.dig_z2 +
- ((s16)(((((s32)mag_trim.dig_z1) *
- ((((s16)v_data_r_u16) << BMI160_SHIFT_1_POSITION))) +
- (C_BMI160_ONE_U8X << BMI160_SHIFT_15_POSITION))
- >> BMI160_SHIFT_16_POSITION))));
- }
- } else {
- retval = BMI160_MAG_OVERFLOW_OUTPUT;
- }
- return retval;
- }
- /*!
- * @brief This function used for initialize the bmm150 sensor
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bmm150_mag_interface_init(void)
- {
- /* This variable used for provide the communication
- results*/
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_pull_value_u8 = C_BMI160_ZERO_U8X;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* accel operation mode to normal*/
- com_rslt = bmi160_set_command_register(ACCEL_MODE_NORMAL);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt = bmi160_set_command_register(MAG_MODE_NORMAL);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_mag_power_mode_stat(&v_data_u8);
- /* register 0x7E write the 0x37, 0x9A and 0x30*/
- com_rslt += bmi160_set_command_register(BMI160_COMMAND_REG_ONE);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_command_register(BMI160_COMMAND_REG_TWO);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_command_register(BMI160_COMMAND_REG_THREE);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /*switch the page1*/
- com_rslt += bmi160_set_target_page(BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_target_page(&v_data_u8);
- com_rslt += bmi160_set_paging_enable(BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_paging_enable(&v_data_u8);
- /* enable the pullup configuration from
- the register 0x85 bit 4 and 5 */
- bmi160_get_pullup_configuration(&v_pull_value_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- v_pull_value_u8 = v_pull_value_u8 | BMI160_HEX_0_3_DATA;
- com_rslt += bmi160_set_pullup_configuration(v_pull_value_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /*switch the page0*/
- com_rslt += bmi160_set_target_page(BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_target_page(&v_data_u8);
- /* Write the BMM150 i2c address*/
- com_rslt += bmi160_set_i2c_device_addr(BMI160_BMM150_I2C_ADDRESS);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* enable the mag interface to manual mode*/
- com_rslt += bmi160_set_mag_manual_enable(BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_mag_manual_enable(&v_data_u8);
- /*Enable the MAG interface */
- com_rslt += bmi160_set_if_mode(BMI160_HEX_0_2_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_if_mode(&v_data_u8);
- /* Mag normal mode*/
- com_rslt += bmi160_bmm150_mag_wakeup();
- /* write the power mode register*/
- com_rslt += bmi160_set_mag_write_data(BMI160_HEX_0_6_DATA);
- /*write 0x4C register to write set power mode to normal*/
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWE_MODE_REG);
- /* read the mag trim values*/
- com_rslt += bmi160_read_bmm150_mag_trim();
- /* To avoid the auto mode enable when manual mode operation running*/
- V_bmm150_maual_auto_condition_u8 = BMM150_HEX_0_1_DATA;
- /* write the XY and Z repetitions*/
- com_rslt += bmi160_set_bmm150_mag_presetmode(
- BMI160_MAG_PRESETMODE_REGULAR);
- /* To avoid the auto mode enable when manual mode operation running*/
- V_bmm150_maual_auto_condition_u8 = BMM150_HEX_0_0_DATA;
- /* Set the power mode of mag as force mode*/
- /* The data have to write for the register
- It write the value in the register 0x4F */
- com_rslt += bmi160_set_mag_write_data(BMM150_FORCE_MODE);
- /* write into power mode register*/
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWE_MODE_REG);
- /* write the mag v_data_bw_u8 as 25Hz*/
- com_rslt += bmi160_set_mag_output_data_rate(
- BMI160_MAG_OUTPUT_DATA_RATE_25HZ);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* When mag interface is auto mode - The mag read address
- starts the register 0x42*/
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_BMM150_DATA_REG);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* enable mag interface to auto mode*/
- com_rslt += bmi160_set_mag_manual_enable(BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_mag_manual_enable(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- return com_rslt;
- }
- /*!
- * @brief This function used for set the mag power control
- * bit enable
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bmm150_mag_wakeup(void)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 try_times = BMM150_MAX_RETRY_WAKEUP;
- u8 v_power_control_bit_u8 = C_BMI160_ZERO_U8X;
- u8 i = C_BMI160_ZERO_U8X;
- for (i = C_BMI160_ZERO_U8X; i < try_times; i++) {
- com_rslt = bmi160_set_mag_write_data(BMM150_POWER_ON);
- p_bmi160->delay_msec(C_BMI160_TWO_U8X);
- /*write 0x4B register to enable power control bit*/
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWE_CONTROL_REG);
- p_bmi160->delay_msec(C_BMI160_THREE_U8X);
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_BMM150_POWE_CONTROL_REG);
- /* 0x04 is secondary read mag x lsb register */
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_read_reg(BMI160_USER_DATA_0_ADDR,
- &v_power_control_bit_u8, C_BMI160_ONE_U8X);
- v_power_control_bit_u8 = BMM150_HEX_0_1_DATA
- & v_power_control_bit_u8;
- if (v_power_control_bit_u8 == BMM150_POWER_ON)
- break;
- }
- com_rslt = (i >= try_times) ?
- BMM150_POWER_ON_FAIL : BMM150_POWER_ON_SUCCESS;
- return com_rslt;
- }
- /*!
- * @brief This function used for set the magnetometer
- * power mode.
- * @note
- * Before set the mag power mode
- * make sure the following two point is addressed
- * Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- *
- * @param v_mag_sec_if_pow_mode_u8 : The value of mag power mode
- * value | mode
- * ----------|------------
- * 0 | BMI160_MAG_FORCE_MODE
- * 1 | BMI160_MAG_SUSPEND_MODE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_bmm150_mag_and_secondary_if_power_mode(
- u8 v_mag_sec_if_pow_mode_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* set the accel power mode to NORMAL*/
- com_rslt = bmi160_set_command_register(ACCEL_MODE_NORMAL);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- switch (v_mag_sec_if_pow_mode_u8) {
- case BMI160_MAG_FORCE_MODE:
- /* set mag interface manual mode*/
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA) {
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- /* set the secondary mag power mode as NORMAL*/
- com_rslt += bmi160_set_command_register(MAG_MODE_NORMAL);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* set the mag power mode as FORCE mode*/
- com_rslt += bmi160_bmm150_mag_set_power_mode(FORCE_MODE);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- if (p_bmi160->mag_manual_enable == BMI160_HEX_0_1_DATA) {
- /* set mag interface auto mode*/
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- break;
- case BMI160_MAG_SUSPEND_MODE:
- /* set mag interface manual mode*/
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA) {
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- /* set the mag power mode as SUSPEND mode*/
- com_rslt += bmi160_bmm150_mag_set_power_mode(SUSPEND_MODE);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* set the secondary mag power mode as SUSPEND*/
- com_rslt += bmi160_set_command_register(MAG_MODE_SUSPEND);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This function used for set the magnetometer
- * power mode.
- * @note
- * Before set the mag power mode
- * make sure the following two points are addressed
- * @note
- * 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note
- * 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- * @param v_mag_pow_mode_u8 : The value of mag power mode
- * value | mode
- * ----------|------------
- * 0 | FORCE_MODE
- * 1 | SUSPEND_MODE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bmm150_mag_set_power_mode(
- u8 v_mag_pow_mode_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- switch (v_mag_pow_mode_u8) {
- case FORCE_MODE:
- /* set mag interface manual mode*/
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA) {
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- /* Set the power control bit enabled */
- com_rslt = bmi160_bmm150_mag_wakeup();
- /* write the mag power mode as FORCE mode*/
- com_rslt += bmi160_set_mag_write_data(
- BMM150_FORCE_MODE);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWE_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* To avoid the auto mode enable when manual
- mode operation running*/
- V_bmm150_maual_auto_condition_u8 = BMM150_HEX_0_1_DATA;
- /* set the preset mode */
- com_rslt += bmi160_set_bmm150_mag_presetmode(
- BMI160_MAG_PRESETMODE_REGULAR);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* To avoid the auto mode enable when manual
- mode operation running*/
- V_bmm150_maual_auto_condition_u8 = BMM150_HEX_0_0_DATA;
- /* set the mag read address to data registers*/
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_BMM150_DATA_REG);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* set mag interface auto mode*/
- if (p_bmi160->mag_manual_enable == BMI160_HEX_0_1_DATA) {
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- break;
- case SUSPEND_MODE:
- /* set mag interface manual mode*/
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA) {
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- /* Set the power mode of mag as suspend mode*/
- com_rslt += bmi160_set_mag_write_data(
- BMM150_POWER_OFF);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWE_CONTROL_REG);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This API used to set the pre-set modes of bmm150
- * The pre-set mode setting is depend on data rate and xy and z repetitions
- *
- * @note
- * Before set the mag preset mode
- * make sure the following two points are addressed
- * @note
- * 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note
- * 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- *
- * @param v_mode_u8: The value of pre-set mode selection value
- * value | pre_set mode
- * ----------|------------
- * 1 | BMI160_MAG_PRESETMODE_LOWPOWER
- * 2 | BMI160_MAG_PRESETMODE_REGULAR
- * 3 | BMI160_MAG_PRESETMODE_HIGHACCURACY
- * 4 | BMI160_MAG_PRESETMODE_ENHANCED
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_bmm150_mag_presetmode(u8 v_mode_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* set mag interface manual mode*/
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_1_DATA);
- switch (v_mode_u8) {
- case BMI160_MAG_PRESETMODE_LOWPOWER:
- /* write the XY and Z repetitions*/
- /* The v_data_u8 have to write for the register
- It write the value in the register 0x4F*/
- com_rslt = bmi160_set_mag_write_data(
- BMI160_MAG_LOWPOWER_REPXY);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_XY_REP);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* write the Z repetitions*/
- /* The v_data_u8 have to write for the register
- It write the value in the register 0x4F*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_MAG_LOWPOWER_REPZ);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_Z_REP);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* set the mag v_data_u8 rate as 10 to the register 0x4C*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_MAG_LOWPOWER_DR);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWE_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- case BMI160_MAG_PRESETMODE_REGULAR:
- /* write the XY and Z repetitions*/
- /* The v_data_u8 have to write for the register
- It write the value in the register 0x4F*/
- com_rslt = bmi160_set_mag_write_data(
- BMI160_MAG_REGULAR_REPXY);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_XY_REP);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* write the Z repetitions*/
- /* The v_data_u8 have to write for the register
- It write the value in the register 0x4F*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_MAG_REGULAR_REPZ);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_Z_REP);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* set the mag v_data_u8 rate as 10 to the register 0x4C*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_MAG_REGULAR_DR);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWE_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- case BMI160_MAG_PRESETMODE_HIGHACCURACY:
- /* write the XY and Z repetitions*/
- /* The v_data_u8 have to write for the register
- It write the value in the register 0x4F*/
- com_rslt = bmi160_set_mag_write_data(
- BMI160_MAG_HIGHACCURACY_REPXY);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_XY_REP);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* write the Z repetitions*/
- /* The v_data_u8 have to write for the register
- It write the value in the register 0x4F*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_MAG_HIGHACCURACY_REPZ);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_Z_REP);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* set the mag v_data_u8 rate as 20 to the register 0x4C*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_MAG_HIGHACCURACY_DR);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWE_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- case BMI160_MAG_PRESETMODE_ENHANCED:
- /* write the XY and Z repetitions*/
- /* The v_data_u8 have to write for the register
- It write the value in the register 0x4F*/
- com_rslt = bmi160_set_mag_write_data(
- BMI160_MAG_ENHANCED_REPXY);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_XY_REP);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* write the Z repetitions*/
- /* The v_data_u8 have to write for the register
- It write the value in the register 0x4F*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_MAG_ENHANCED_REPZ);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_Z_REP);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* set the mag v_data_u8 rate as 10 to the register 0x4C*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_MAG_ENHANCED_DR);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWE_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- if (V_bmm150_maual_auto_condition_u8 == BMI160_HEX_0_0_DATA) {
- com_rslt += bmi160_set_mag_write_data(
- BMM150_FORCE_MODE);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWE_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- com_rslt += bmi160_set_mag_read_addr(BMI160_BMM150_DATA_REG);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* set mag interface auto mode*/
- if (p_bmi160->mag_manual_enable == BMI160_HEX_0_1_DATA)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_0_DATA);
- }
- return com_rslt;
- }
- /*!
- * @brief This function used for read the trim values of magnetometer
- *
- * @note
- * Before reading the mag trimming values
- * make sure the following two points are addressed
- * @note
- * 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note
- * 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_bmm150_mag_trim(void)
- {
- /* This variable used for provide the communication
- results*/
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array holding the bmm150 trim data
- */
- u8 v_data_u8[ARRAY_SIZE_SIXTEEN] = {
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X};
- /* read dig_x1 value */
- com_rslt = bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_X1);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_X1], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- mag_trim.dig_x1 = v_data_u8[BMM150_DIG_X1];
- /* read dig_y1 value */
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_Y1);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_Y1],
- C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- mag_trim.dig_y1 = v_data_u8[BMM150_DIG_Y1];
- /* read dig_x2 value */
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_X2);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_X2], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- mag_trim.dig_x2 = v_data_u8[BMM150_DIG_X2];
- /* read dig_y2 value */
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_Y2);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_Y3], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- mag_trim.dig_y2 = v_data_u8[BMM150_DIG_Y3];
- /* read dig_xy1 value */
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_XY1);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_XY1], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- mag_trim.dig_xy1 = v_data_u8[BMM150_DIG_XY1];
- /* read dig_xy2 value */
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_XY2);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is v_mag_x_s16 ls register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_XY2], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- mag_trim.dig_xy2 = v_data_u8[BMM150_DIG_XY2];
- /* read dig_z1 lsb value */
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_Z1_LSB);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_Z1_LSB], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* read dig_z1 msb value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_Z1_MSB);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is v_mag_x_s16 msb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_Z1_MSB], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- mag_trim.dig_z1 =
- (u16)((((u32)((u8)v_data_u8[BMM150_DIG_Z1_MSB]))
- << BMI160_SHIFT_8_POSITION) |
- (v_data_u8[BMM150_DIG_Z1_LSB]));
- /* read dig_z2 lsb value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_Z2_LSB);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_Z2_LSB], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* read dig_z2 msb value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_Z2_MSB);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is v_mag_x_s16 msb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_Z2_MSB], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- mag_trim.dig_z2 =
- (s16)((((s32)((s8)v_data_u8[BMM150_DIG_Z2_MSB]))
- << BMI160_SHIFT_8_POSITION) |
- (v_data_u8[BMM150_DIG_Z2_LSB]));
- /* read dig_z3 lsb value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_Z3_LSB);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_DIG_Z3_LSB], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* read dig_z3 msb value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_Z3_MSB);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is v_mag_x_s16 msb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_DIG_Z3_MSB], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- mag_trim.dig_z3 =
- (s16)((((s32)((s8)v_data_u8[BMM150_DIG_DIG_Z3_MSB]))
- << BMI160_SHIFT_8_POSITION) |
- (v_data_u8[BMM150_DIG_DIG_Z3_LSB]));
- /* read dig_z4 lsb value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_Z4_LSB);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_DIG_Z4_LSB], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* read dig_z4 msb value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_Z4_MSB);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is v_mag_x_s16 msb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_DIG_Z4_MSB], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- mag_trim.dig_z4 =
- (s16)((((s32)((s8)v_data_u8[BMM150_DIG_DIG_Z4_MSB]))
- << BMI160_SHIFT_8_POSITION) |
- (v_data_u8[BMM150_DIG_DIG_Z4_LSB]));
- /* read dig_xyz1 lsb value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_XYZ1_LSB);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_DIG_XYZ1_LSB], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* read dig_xyz1 msb value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_XYZ1_MSB);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is v_mag_x_s16 msb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[BMM150_DIG_DIG_XYZ1_MSB], C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- mag_trim.dig_xyz1 =
- (u16)((((u32)((u8)v_data_u8[BMM150_DIG_DIG_XYZ1_MSB]))
- << BMI160_SHIFT_8_POSITION) |
- (v_data_u8[BMM150_DIG_DIG_XYZ1_LSB]));
- return com_rslt;
- }
- /*!
- * Description: This function used for initialize the AKM09911 sensor
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_akm_mag_interface_init(void)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_pull_value_u8 = C_BMI160_ZERO_U8X;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- /* accel operation mode to normal*/
- com_rslt = bmi160_set_command_register(ACCEL_MODE_NORMAL);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_command_register(MAG_MODE_NORMAL);
- p_bmi160->delay_msec(C_BMI160_SIXTY_U8X);
- bmi160_get_mag_power_mode_stat(&v_data_u8);
- /* register 0x7E write the 0x37, 0x9A and 0x30*/
- com_rslt += bmi160_set_command_register(BMI160_COMMAND_REG_ONE);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- com_rslt += bmi160_set_command_register(BMI160_COMMAND_REG_TWO);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- com_rslt += bmi160_set_command_register(BMI160_COMMAND_REG_THREE);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /*switch the page1*/
- com_rslt += bmi160_set_target_page(BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_target_page(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_paging_enable(BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_paging_enable(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* enable the pullup configuration from
- the register 0x85 bit 4 and 5 */
- bmi160_get_pullup_configuration(&v_pull_value_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- v_pull_value_u8 = v_pull_value_u8 | BMI160_HEX_0_3_DATA;
- com_rslt += bmi160_set_pullup_configuration(v_pull_value_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /*switch the page0*/
- com_rslt += bmi160_set_target_page(BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_target_page(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* Write the AKM i2c address*/
- com_rslt += bmi160_set_i2c_device_addr(BMI160_AKM09911_I2C_ADDRESS);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* enable the mag interface to manual mode*/
- com_rslt += bmi160_set_mag_manual_enable(BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_mag_manual_enable(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /*Enable the MAG interface */
- com_rslt += bmi160_set_if_mode(BMI160_HEX_0_2_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_if_mode(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* Set the AKM Fuse ROM mode */
- /* Set value for fuse ROM mode*/
- com_rslt += bmi160_set_mag_write_data(AKM_FUSE_ROM_MODE);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* AKM mode address is 0x31*/
- com_rslt += bmi160_set_mag_write_addr(AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* Read the Fuse ROM v_data_u8 from registers
- 0x60,0x61 and 0x62*/
- /* ASAX v_data_u8 */
- com_rslt += bmi160_read_bst_akm_sensitivity_data();
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* Set value power down mode mode*/
- com_rslt += bmi160_set_mag_write_data(AKM_POWER_DOWN_MODE_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* AKM mode address is 0x31*/
- com_rslt += bmi160_set_mag_write_addr(AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* Set AKM Force mode*/
- com_rslt += bmi160_set_mag_write_data(
- AKM_SINGLE_MEASUREMENT_MODE);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* AKM mode address is 0x31*/
- com_rslt += bmi160_set_mag_write_addr(AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* Set the AKM read xyz v_data_u8 address*/
- com_rslt += bmi160_set_mag_read_addr(AKM_DATA_REGISTER);
- /* write the mag v_data_bw_u8 as 25Hz*/
- com_rslt += bmi160_set_mag_output_data_rate(
- BMI160_MAG_OUTPUT_DATA_RATE_25HZ);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* Enable mag interface to auto mode*/
- com_rslt += bmi160_set_mag_manual_enable(BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_mag_manual_enable(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- return com_rslt;
- }
- /*!
- * @brief This function used for read the sensitivity data of
- * AKM09911
- *
- * @note Before reading the mag sensitivity values
- * make sure the following two points are addressed
- * @note 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_bst_akm_sensitivity_data(void)
- {
- /* This variable used for provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array holding the sensitivity ax,ay and az data*/
- u8 v_data_u8[ARRAY_SIZE_THREE] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- /* read asax value */
- com_rslt = bmi160_set_mag_read_addr(BMI160_BST_AKM_ASAX);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[AKM_ASAX],
- C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- akm_asa_data.asax = v_data_u8[AKM_ASAX];
- /* read asay value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_BST_AKM_ASAY);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[AKM_ASAY],
- C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- akm_asa_data.asay = v_data_u8[AKM_ASAY];
- /* read asaz value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_BST_AKM_ASAZ);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[AKM_ASAZ],
- C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- akm_asa_data.asaz = v_data_u8[AKM_ASAZ];
- return com_rslt;
- }
- /*!
- * @brief This API used to get the compensated X data
- * of AKM09911 the out put of X as s16
- * @note Before start reading the mag compensated X data
- * make sure the following two points are addressed
- * @note 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- *
- * @param v_bst_akm_x_s16 : The value of X data
- *
- * @return results of compensated X data value output as s16
- *
- */
- s16 bmi160_bst_akm_compensate_X(s16 v_bst_akm_x_s16)
- {
- /*Return value of AKM x compensated v_data_u8*/
- s16 retval = C_BMI160_ZERO_U8X;
- /* Convert raw v_data_u8 into compensated v_data_u8*/
- retval = (v_bst_akm_x_s16 *
- ((akm_asa_data.asax/AKM09911_SENSITIVITY_DIV) +
- C_BMI160_ONE_U8X));
- return retval;
- }
- /*!
- * @brief This API used to get the compensated Y data
- * of AKM09911 the out put of Y as s16
- * @note Before start reading the mag compensated Y data
- * make sure the following two points are addressed
- * @note 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- *
- * @param v_bst_akm_y_s16 : The value of Y data
- *
- * @return results of compensated Y data value output as s16
- *
- */
- s16 bmi160_bst_akm_compensate_Y(s16 v_bst_akm_y_s16)
- {
- /*Return value of AKM y compensated v_data_u8*/
- s16 retval = C_BMI160_ZERO_U8X;
- /* Convert raw v_data_u8 into compensated v_data_u8*/
- retval = (v_bst_akm_y_s16 *
- ((akm_asa_data.asay/AKM09911_SENSITIVITY_DIV) +
- C_BMI160_ONE_U8X));
- return retval;
- }
- /*!
- * @brief This API used to get the compensated Z data
- * of AKM09911 the out put of Z as s16
- * @note Before start reading the mag compensated Z data
- * make sure the following two points are addressed
- * @note 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- *
- * @param v_bst_akm_z_s16 : The value of Z data
- *
- * @return results of compensated Z data value output as s16
- *
- */
- s16 bmi160_bst_akm_compensate_Z(s16 v_bst_akm_z_s16)
- {
- /*Return value of AKM z compensated v_data_u8*/
- s16 retval = C_BMI160_ZERO_U8X;
- /* Convert raw v_data_u8 into compensated v_data_u8*/
- retval = (v_bst_akm_z_s16 *
- ((akm_asa_data.asaz/AKM09911_SENSITIVITY_DIV) +
- C_BMI160_ONE_U8X));
- return retval;
- }
- /*!
- * @brief This function used for read the compensated value of
- * AKM09911
- * @note Before start reading the mag compensated v_data_u8's
- * make sure the following two points are addressed
- * @note 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_akm_compensate_xyz(
- struct bmi160_bst_akm_xyz_t *bst_akm_xyz)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- struct bmi160_mag_t mag_xyz;
- com_rslt = bmi160_read_mag_xyz(&mag_xyz, C_BMI160_ONE_U8X);
- /* Compensation for X axis */
- bst_akm_xyz->x = bmi160_bst_akm_compensate_X(mag_xyz.x);
- /* Compensation for Y axis */
- bst_akm_xyz->y = bmi160_bst_akm_compensate_Y(mag_xyz.y);
- /* Compensation for Z axis */
- bst_akm_xyz->z = bmi160_bst_akm_compensate_Z(mag_xyz.z);
- return com_rslt;
- }
- /*!
- * @brief This function used for set the AKM09911
- * power mode.
- * @note Before set the AKM power mode
- * make sure the following two points are addressed
- * @note 1. Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- * @note 2. And also confirm the secondary-interface power mode
- * is not in the SUSPEND mode.
- * by using the function bmi160_get_mag_pmu_status().
- * If the secondary-interface power mode is in SUSPEND mode
- * set the value of 0x19(NORMAL mode)by using the
- * bmi160_set_command_register(0x19) function.
- *
- * @param v_akm_pow_mode_u8 : The value of akm power mode
- * value | Description
- * ---------|--------------------
- * 0 | AKM_POWER_DOWN_MODE
- * 1 | AKM_SINGLE_MEAS_MODE
- * 2 | FUSE_ROM_MODE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_akm_set_powermode(
- u8 v_akm_pow_mode_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- switch (v_akm_pow_mode_u8) {
- case AKM_POWER_DOWN_MODE:
- /* set mag interface manual mode*/
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA) {
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- /* Set the power mode of AKM as power down mode*/
- com_rslt += bmi160_set_mag_write_data(AKM_POWER_DOWN_MODE_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* set mag interface auto mode*/
- if (p_bmi160->mag_manual_enable == BMI160_HEX_0_1_DATA) {
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- break;
- case AKM_SINGLE_MEAS_MODE:
- /* set mag interface manual mode*/
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA) {
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- /* Set the power mode of AKM as
- single measurement mode*/
- com_rslt += bmi160_set_mag_write_data
- (AKM_SINGLE_MEASUREMENT_MODE);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- com_rslt += bmi160_set_mag_read_addr(AKM_DATA_REGISTER);
- /* set mag interface auto mode*/
- if (p_bmi160->mag_manual_enable == BMI160_HEX_0_1_DATA) {
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- break;
- case FUSE_ROM_MODE:
- /* set mag interface manual mode*/
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA) {
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- /* Set the power mode of AKM as
- Fuse ROM mode*/
- com_rslt += bmi160_set_mag_write_data(AKM_FUSE_ROM_MODE);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* Sensitivity v_data_u8 */
- com_rslt += bmi160_read_bst_akm_sensitivity_data();
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* power down mode*/
- com_rslt += bmi160_set_mag_write_data(AKM_POWER_DOWN_MODE);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* set mag interface auto mode*/
- if (p_bmi160->mag_manual_enable == BMI160_HEX_0_1_DATA) {
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This function used for set the magnetometer
- * power mode.
- * @note Before set the mag power mode
- * make sure the following two point is addressed
- * Make sure the mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If mag interface is not enabled set the value of 0x02
- * to the function bmi160_get_if_mode(0x02)
- *
- * @param v_mag_sec_if_pow_mode_u8 : The value of secondary if power mode
- * value | Description
- * ---------|--------------------
- * 0 | BMI160_MAG_FORCE_MODE
- * 1 | BMI160_MAG_SUSPEND_MODE
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_bst_akm_and_secondary_if_powermode(
- u8 v_mag_sec_if_pow_mode_u8)
- {
- /* variable used for return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* accel operation mode to normal*/
- com_rslt = bmi160_set_command_register(ACCEL_MODE_NORMAL);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- switch (v_mag_sec_if_pow_mode_u8) {
- case BMI160_MAG_FORCE_MODE:
- /* set mag interface manual mode*/
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA) {
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- }
- /* set the secondary mag power mode as NORMAL*/
- com_rslt += bmi160_set_command_register(MAG_MODE_NORMAL);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* set the akm power mode as single measurement mode*/
- com_rslt += bmi160_bst_akm_set_powermode(AKM_SINGLE_MEAS_MODE);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- com_rslt += bmi160_set_mag_read_addr(AKM_DATA_REGISTER);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* set mag interface auto mode*/
- if (p_bmi160->mag_manual_enable == BMI160_HEX_0_1_DATA)
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- case BMI160_MAG_SUSPEND_MODE:
- /* set mag interface manual mode*/
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* set the akm power mode as power down mode*/
- com_rslt += bmi160_bst_akm_set_powermode(AKM_POWER_DOWN_MODE);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* set the secondary mag power mode as SUSPEND*/
- com_rslt += bmi160_set_command_register(MAG_MODE_SUSPEND);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* set mag interface auto mode*/
- if (p_bmi160->mag_manual_enable == BMI160_HEX_0_1_DATA)
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This function used for read the YAMAH-YAS532 init
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yamaha_yas532_mag_interface_init(
- void)
- {
- /* This variable used for provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_pull_value_u8 = C_BMI160_ZERO_U8X;
- u8 v_data_u8 = C_BMI160_ZERO_U8X;
- u8 i = C_BMI160_ZERO_U8X;
- /* accel operation mode to normal*/
- com_rslt = bmi160_set_command_register(ACCEL_MODE_NORMAL);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_command_register(MAG_MODE_NORMAL);
- p_bmi160->delay_msec(C_BMI160_SIXTY_U8X);
- bmi160_get_mag_power_mode_stat(&v_data_u8);
- /* register 0x7E write the 0x37, 0x9A and 0x30*/
- com_rslt += bmi160_set_command_register(BMI160_COMMAND_REG_ONE);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- com_rslt += bmi160_set_command_register(BMI160_COMMAND_REG_TWO);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- com_rslt += bmi160_set_command_register(BMI160_COMMAND_REG_THREE);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /*switch the page1*/
- com_rslt += bmi160_set_target_page(BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_target_page(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_paging_enable(BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_paging_enable(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* enable the pullup configuration from
- the register 0x85 bit 4 and 5 */
- bmi160_get_pullup_configuration(&v_pull_value_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- v_pull_value_u8 = v_pull_value_u8 | BMI160_HEX_0_3_DATA;
- com_rslt += bmi160_set_pullup_configuration(v_pull_value_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /*switch the page0*/
- com_rslt += bmi160_set_target_page(BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_target_page(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* Write the YAS532 i2c address*/
- com_rslt += bmi160_set_i2c_device_addr(BMI160_YAS532_I2C_ADDRESS);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* enable the mag interface to manual mode*/
- com_rslt += bmi160_set_mag_manual_enable(BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_mag_manual_enable(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /*Enable the MAG interface */
- com_rslt += bmi160_set_if_mode(BMI160_HEX_0_2_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_if_mode(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- v_data_u8 = BMI160_HEX_0_0_DATA;
- /* Read the YAS532 device id*/
- com_rslt += bmi160_set_mag_read_addr(BMI160_HEX_8_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8, C_BMI160_ONE_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* Read the YAS532 calibration data*/
- com_rslt += bmi160_bst_yamaha_yas532_calib_values();
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* Assign the data acquisition mode*/
- yas532_data.measure_state = YAS532_MAG_STATE_INIT_COIL;
- /* Set the default offset as invalid offset*/
- set_vector(yas532_data.v_hard_offset_s8, INVALID_OFFSET);
- /* set the transform to zero */
- yas532_data.transform = BMI160_NULL;
- /* Assign overflow as zero*/
- yas532_data.overflow = C_BMI160_ZERO_U8X;
- #if 1 < YAS532_MAG_TEMPERATURE_LOG
- yas532_data.temp_data.num =
- yas532_data.temp_data.idx = C_BMI160_ZERO_U8X;
- #endif
- /* Assign the coef value*/
- for (i = C_BMI160_ZERO_U8X; i < C_BMI160_THREE_U8X; i++) {
- yas532_data.coef[i] = yas532_version_ac_coef[i];
- yas532_data.last_raw[i] = C_BMI160_ZERO_U8X;
- }
- yas532_data.last_raw[INDEX_THREE] = C_BMI160_ZERO_U8X;
- /* Set the initial values of yas532*/
- com_rslt += bmi160_bst_yas532_set_initial_values();
- /* write the mag v_data_bw_u8 as 25Hz*/
- com_rslt += bmi160_set_mag_output_data_rate(
- BMI160_MAG_OUTPUT_DATA_RATE_25HZ);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* Enable mag interface to auto mode*/
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- bmi160_get_mag_manual_enable(&v_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- return com_rslt;
- }
- /*!
- * @brief This function used to set the YAS532 initial values
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yas532_set_initial_values(void)
- {
- /* This variable used for provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* write testr1 as 0x00*/
- com_rslt = bmi160_set_mag_write_data(
- BMI160_YAS532_WRITE_DATA_ZERO);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_TESTR1);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* write testr2 as 0x00*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_YAS532_WRITE_DATA_ZERO);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_TESTR2);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- /* write Rcoil as 0x00*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_YAS532_WRITE_DATA_ZERO);
- p_bmi160->delay_msec(C_BMI160_FIVE_U8X);
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_RCOIL);
- p_bmi160->delay_msec(C_BMI160_TWO_HUNDRED_U8X);
- /* check the valid offset*/
- if (is_valid_offset(yas532_data.v_hard_offset_s8)) {
- com_rslt += bmi160_bst_yas532_set_offset(
- yas532_data.v_hard_offset_s8);
- yas532_data.measure_state = YAS532_MAG_STATE_NORMAL;
- } else {
- /* set the default offset as invalid offset*/
- set_vector(yas532_data.v_hard_offset_s8, INVALID_OFFSET);
- /*Set the default measure state for offset correction*/
- yas532_data.measure_state = YAS532_MAG_STATE_MEASURE_OFFSET;
- }
- return com_rslt;
- }
- /*!
- * @brief This function used for YAS532 offset correction
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yas532_magnetic_measure_set_offset(
- void)
- {
- /* This variable used for provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* used for offset value set to the offset register*/
- s8 v_hard_offset_s8[ARRAY_SIZE_THREE] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- /* offset correction factors*/
- static const u8 v_correct_u8[ARRAY_SIZE_FIVE] = {
- YAS532_CORRECT_OFFSET_16,
- YAS532_CORRECT_OFFSET_8, YAS532_CORRECT_OFFSET_4,
- YAS532_CORRECT_OFFSET_2, YAS532_CORRECT_OFFSET_1};
- /* used for the temperature */
- u16 v_temp_u16 = C_BMI160_ZERO_U8X;
- /* used for the xy1y2 read*/
- u16 v_xy1y2_u16[ARRAY_SIZE_THREE] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- /* local flag for assign the values*/
- s32 v_flag_s32[ARRAY_SIZE_THREE] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- u8 i, j, v_busy_u8, v_overflow_u8 = C_BMI160_ZERO_U8X;
- for (i = C_BMI160_ZERO_U8X; i < C_BMI160_FIVE_U8X; i++) {
- /* set the offset values*/
- com_rslt = bmi160_bst_yas532_set_offset(v_hard_offset_s8);
- /* read the sensor data*/
- com_rslt += bmi160_bst_yas532_normal_measurement_data(
- BMI160_HEX_1_1_DATA, &v_busy_u8, &v_temp_u16,
- v_xy1y2_u16, &v_overflow_u8);
- /* check the sensor busy status*/
- if (v_busy_u8)
- return E_BMI160_BUSY;
- /* calculate the magnetic correction with
- offset and assign the values
- to the offset register */
- for (j = C_BMI160_ZERO_U8X; j < C_BMI160_THREE_U8X; j++) {
- if (YAS532_DATA_CENTER == v_xy1y2_u16[j])
- v_flag_s32[j] = C_BMI160_ZERO_U8X;
- if (YAS532_DATA_CENTER < v_xy1y2_u16[j])
- v_flag_s32[j] = C_BMI160_ONE_U8X;
- if (v_xy1y2_u16[j] < YAS532_DATA_CENTER)
- v_flag_s32[j] = C_BMI160_MINUS_ONE_S8X;
- }
- for (j = C_BMI160_ZERO_U8X; j < C_BMI160_THREE_U8X; j++) {
- if (v_flag_s32[j])
- v_hard_offset_s8[j] = (s8)(v_hard_offset_s8[j]
- + v_flag_s32[j] * v_correct_u8[i]);
- }
- }
- /* set the offset */
- com_rslt += bmi160_bst_yas532_set_offset(v_hard_offset_s8);
- return com_rslt;
- }
- /*!
- * @brief This function used for read the
- * YAMAHA YAS532 calibration data
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yamaha_yas532_calib_values(void)
- {
- /* This variable used for provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array holding the YAS532 calibration values */
- u8 v_data_u8[ARRAY_SIZE_FOURTEEN] = {
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- /* Read the DX value */
- com_rslt = bmi160_set_mag_read_addr(BMI160_YAS532_CALIB_CX);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[YAS532_CALIB_CX], C_BMI160_ONE_U8X);
- yas532_data.calib_yas532.cx = (s32)((v_data_u8[YAS532_CALIB_CX]
- * C_BMI160_TEN_U8X) -
- YAS532_CALIB_THOUSAND_TWO_EIGHTY);
- /* Read the DY1 value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB_CY1);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[YAS532_CALIB_CY1], C_BMI160_ONE_U8X);
- yas532_data.calib_yas532.cy1 =
- (s32)((v_data_u8[YAS532_CALIB_CY1] * C_BMI160_TEN_U8X) -
- YAS532_CALIB_THOUSAND_TWO_EIGHTY);
- /* Read the DY2 value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB_CY2);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[YAS532_CALIB_CY2], C_BMI160_ONE_U8X);
- yas532_data.calib_yas532.cy2 =
- (s32)((v_data_u8[YAS532_CALIB_CY2] * C_BMI160_TEN_U8X) -
- YAS532_CALIB_THOUSAND_TWO_EIGHTY);
- /* Read the D2 and D3 value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB1);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[INDEX_THREE], C_BMI160_ONE_U8X);
- yas532_data.calib_yas532.a2 =
- (s32)(((v_data_u8[INDEX_THREE] >> C_BMI160_TWO_U8X)
- & YAS532_CALIB_HEX_ZERO_THREE_F) - C_BMI160_THIRTY_TWO_U8X);
- /* Read the D3 and D4 value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB2);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[INDEX_FOUR], C_BMI160_ONE_U8X);
- /* calculate a3*/
- yas532_data.calib_yas532.a3 = (s32)((((v_data_u8[INDEX_THREE] <<
- C_BMI160_TWO_U8X) & YAS532_CALIB_HEX_ZERO_C) |
- ((v_data_u8[INDEX_FOUR]
- >> C_BMI160_SIX_U8X) & YAS532_CALIB_HEX_ZERO_THREE)) -
- C_BMI160_EIGHT_U8X);
- /* calculate a4*/
- yas532_data.calib_yas532.a4 = (s32)((v_data_u8[INDEX_FOUR]
- & YAS532_CALIB_HEX_THREE_F) - C_BMI160_THIRTY_TWO_U8X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* Read the D5 and D6 value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB3);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[INDEX_FIVE], C_BMI160_ONE_U8X);
- /* calculate a5*/
- yas532_data.calib_yas532.a5 =
- (s32)(((v_data_u8[INDEX_FIVE] >> C_BMI160_TWO_U8X)
- & YAS532_CALIB_HEX_THREE_F) + C_BMI160_THIRTY_EIGHT_U8X);
- /* Read the D6 and D7 value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB4);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[INDEX_SIX], C_BMI160_ONE_U8X);
- /* calculate a6*/
- yas532_data.calib_yas532.a6 =
- (s32)((((v_data_u8[INDEX_FIVE] << C_BMI160_FOUR_U8X)
- & YAS532_CALIB_HEX_THREE_ZERO) |
- ((v_data_u8[INDEX_SIX] >>
- C_BMI160_FOUR_U8X) & YAS532_CALIB_HEX_ZERO_F)) -
- C_BMI160_THIRTY_TWO_U8X);
- /* Read the D7 and D8 value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB5);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[INDEX_SEVEN], C_BMI160_ONE_U8X);
- /* calculate a7*/
- yas532_data.calib_yas532.a7 = (s32)((((v_data_u8[INDEX_SIX]
- << C_BMI160_THREE_U8X) & YAS532_CALIB_HEX_SEVEN_EIGHT) |
- ((v_data_u8[INDEX_SEVEN] >> C_BMI160_FIVE_U8X) &
- YAS532_CALIB_HEX_ZERO_SEVEN)) -
- C_BMI160_SIXTY_FOUR_U8X);
- /* Read the D8 and D9 value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CLAIB6);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[INDEX_EIGHT], C_BMI160_ONE_U8X);
- /* calculate a8*/
- yas532_data.calib_yas532.a8 = (s32)((((v_data_u8[INDEX_SEVEN] <<
- C_BMI160_ONE_U8X) & YAS532_CALIB_HEX_THREE_E) |
- ((v_data_u8[INDEX_EIGHT] >>
- C_BMI160_SEVEN_U8X) & YAS532_CALIB_HEX_ZERO_ONE)) -
- C_BMI160_THIRTY_TWO_U8X);
- /* Read the D8 and D9 value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB7);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[INDEX_NINE], C_BMI160_ONE_U8X);
- /* calculate a9*/
- yas532_data.calib_yas532.a9 = (s32)(((v_data_u8[INDEX_EIGHT] <<
- C_BMI160_ONE_U8X) & YAS532_CALIB_HEX_F_E) |
- ((v_data_u8[INDEX_NINE] >>
- C_BMI160_SEVEN_U8X) & YAS532_CALIB_HEX_ZERO_ONE));
- /* calculate k*/
- yas532_data.calib_yas532.k = (s32)((v_data_u8[INDEX_NINE] >>
- C_BMI160_TWO_U8X) & YAS532_CALIB_HEX_ONE_F);
- /* Read the value from register 0x9A*/
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB8);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[INDEX_TEN],
- C_BMI160_ONE_U8X);
- /* Read the value from register 0x9B*/
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIIB9);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[INDEX_ELEVEN],
- C_BMI160_ONE_U8X);
- /* Read the value from register 0x9C*/
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB10);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[INDEX_TWELVE],
- C_BMI160_ONE_U8X);
- /* Read the value from register 0x9D*/
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB11);
- /* 0x04 is secondary read mag x lsb register */
- com_rslt += bmi160_read_reg(BMI160_HEX_0_4_DATA,
- &v_data_u8[INDEX_THIRTEEN],
- C_BMI160_ONE_U8X);
- /* Calculate the fxy1y2 and rxy1y1*/
- yas532_data.calib_yas532.fxy1y2[INDEX_ZERO] =
- (u8)(((v_data_u8[INDEX_TEN]
- & YAS532_CALIB_HEX_ZERO_ONE)
- << C_BMI160_ONE_U8X)
- | ((v_data_u8[INDEX_ELEVEN] >>
- C_BMI160_SEVEN_U8X) & YAS532_CALIB_HEX_ZERO_ONE));
- yas532_data.calib_yas532.rxy1y2[INDEX_ZERO] =
- ((s8)(((v_data_u8[INDEX_TEN]
- >> C_BMI160_ONE_U8X)
- & YAS532_CALIB_HEX_THREE_F)
- << C_BMI160_TWO_U8X)) >> C_BMI160_TWO_U8X;
- yas532_data.calib_yas532.fxy1y2[INDEX_ONE] =
- (u8)(((v_data_u8[INDEX_ELEVEN]
- & YAS532_CALIB_HEX_ZERO_ONE)
- << C_BMI160_ONE_U8X)
- | ((v_data_u8[INDEX_TWELVE] >>
- C_BMI160_SEVEN_U8X) & YAS532_CALIB_HEX_ZERO_ONE));
- yas532_data.calib_yas532.rxy1y2[INDEX_ONE] =
- ((s8)(((v_data_u8[INDEX_ELEVEN]
- >> C_BMI160_ONE_U8X) & YAS532_CALIB_HEX_THREE_F)
- << C_BMI160_TWO_U8X)) >> C_BMI160_TWO_U8X;
- yas532_data.calib_yas532.fxy1y2[INDEX_TWO] =
- (u8)(((v_data_u8[INDEX_TWELVE]
- & YAS532_CALIB_HEX_ZERO_ONE)
- << C_BMI160_ONE_U8X)
- | ((v_data_u8[INDEX_THIRTEEN] >> C_BMI160_SEVEN_U8X)
- & YAS532_CALIB_HEX_ZERO_ONE));
- yas532_data.calib_yas532.rxy1y2[INDEX_TWO] =
- ((s8)(((v_data_u8[INDEX_TWELVE]
- >> C_BMI160_ONE_U8X) & YAS532_CALIB_HEX_THREE_F)
- << C_BMI160_TWO_U8X)) >> C_BMI160_TWO_U8X;
- return com_rslt;
- }
- /*!
- * @brief This function used for calculate the
- * YAS532 read the linear data
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yas532_xy1y2_to_linear(
- u16 *v_xy1y2_u16, s32 *xy1y2_linear)
- {
- /* This variable used for provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = SUCCESS;
- static const u16 v_calib_data[] = {
- CALIB_LINEAR_3721, CALIB_LINEAR_3971,
- CALIB_LINEAR_4221, CALIB_LINEAR_4471};
- u8 i = C_BMI160_ZERO_U8X;
- for (i = C_BMI160_ZERO_U8X; i < C_BMI160_THREE_U8X; i++)
- xy1y2_linear[i] = v_xy1y2_u16[i] -
- v_calib_data[yas532_data.calib_yas532.fxy1y2[i]]
- + (yas532_data.v_hard_offset_s8[i] -
- yas532_data.calib_yas532.rxy1y2[i])
- * yas532_data.coef[i];
- return com_rslt;
- }
- /*!
- * @brief This function used for read the YAS532 sensor data
- * @param v_acquisition_command_u8: used to set the data acquisition
- * acquisition_command | operation
- * ---------------------|-------------------------
- * 0x17 | turn on the acquisition coil
- * - | set direction of the coil
- * _ | (x and y as minus(-))
- * _ | Deferred acquisition mode
- * 0x07 | turn on the acquisition coil
- * _ | set direction of the coil
- * _ | (x and y as minus(-))
- * _ | Normal acquisition mode
- * 0x11 | turn OFF the acquisition coil
- * _ | set direction of the coil
- * _ | (x and y as plus(+))
- * _ | Deferred acquisition mode
- * 0x01 | turn OFF the acquisition coil
- * _ | set direction of the coil
- * _ | (x and y as plus(+))
- * _ | Normal acquisition mode
- *
- * @param v_busy_u8 : used to get the busy flay for sensor data read
- * @param v_temp_u16 : used to get the temperature data
- * @param v_xy1y2_u16 : used to get the sensor xy1y2 data
- * @param v_overflow_u8 : used to get the overflow data
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yas532_normal_measurement_data(
- u8 v_acquisition_command_u8, u8 *v_busy_u8,
- u16 *v_temp_u16, u16 *v_xy1y2_u16, u8 *v_overflow_u8)
- {
- /* This variable used for provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array holding the YAS532 xyy1 data*/
- u8 v_data_u8[ARRAY_SIZE_EIGHT] = {
- C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- u8 i = C_BMI160_ZERO_U8X;
- /* check the p_bmi160 structure as NULL*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the sensor data */
- com_rslt = bmi160_bst_yas532_acquisition_command_register(
- v_acquisition_command_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_MAG_X_LSB__REG,
- v_data_u8, C_BMI160_EIGHT_U8X);
- /* read the xyy1 data*/
- *v_busy_u8 =
- ((v_data_u8[INDEX_ZERO] >> C_BMI160_SEVEN_U8X)
- & YAS532_HEX_ZERO_ONE);
- *v_temp_u16 =
- (u16)((((s32)v_data_u8[INDEX_ZERO] << C_BMI160_THREE_U8X)
- & YAS532_HEX_THREE_F_EIGHT) |
- ((v_data_u8[INDEX_ONE] >> C_BMI160_FIVE_U8X)
- & YAS532_HEX_ZERO_SEVEN));
- v_xy1y2_u16[INDEX_ZERO] =
- (u16)((((s32)v_data_u8[INDEX_TWO] << C_BMI160_SIX_U8X)
- & YAS532_HEX_ONE_F_C_ZERO)
- | ((v_data_u8[INDEX_THREE] >> C_BMI160_TWO_U8X)
- & YAS532_HEX_THREE_F));
- v_xy1y2_u16[INDEX_ONE] =
- (u16)((((s32)v_data_u8[INDEX_FOUR] << C_BMI160_SIX_U8X)
- & YAS532_HEX_ONE_F_C_ZERO)
- | ((v_data_u8[INDEX_FIVE]
- >> C_BMI160_TWO_U8X) & YAS532_HEX_THREE_F));
- v_xy1y2_u16[INDEX_TWO] =
- (u16)((((s32)v_data_u8[INDEX_SIX] << C_BMI160_SIX_U8X)
- & YAS532_HEX_ONE_F_C_ZERO)
- | ((v_data_u8[INDEX_SEVEN]
- >> C_BMI160_TWO_U8X) & YAS532_HEX_THREE_F));
- *v_overflow_u8 = C_BMI160_ZERO_U8X;
- for (i = C_BMI160_ZERO_U8X; i < C_BMI160_THREE_U8X; i++) {
- if (v_xy1y2_u16[i] == YAS532_DATA_OVERFLOW)
- *v_overflow_u8 |= (C_BMI160_ONE_U8X
- << (i * C_BMI160_TWO_U8X));
- if (v_xy1y2_u16[i] == YAS532_DATA_UNDERFLOW)
- *v_overflow_u8 |= (C_BMI160_ONE_U8X <<
- (i * C_BMI160_TWO_U8X + C_BMI160_ONE_U8X));
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This function used for YAS532 sensor data
- * @param v_acquisition_command_u8 : the value of CMDR
- * acquisition_command | operation
- * ---------------------|-------------------------
- * 0x17 | turn on the acquisition coil
- * - | set direction of the coil
- * _ | (x and y as minus(-))
- * _ | Deferred acquisition mode
- * 0x07 | turn on the acquisition coil
- * _ | set direction of the coil
- * _ | (x and y as minus(-))
- * _ | Normal acquisition mode
- * 0x11 | turn OFF the acquisition coil
- * _ | set direction of the coil
- * _ | (x and y as plus(+))
- * _ | Deferred acquisition mode
- * 0x01 | turn OFF the acquisition coil
- * _ | set direction of the coil
- * _ | (x and y as plus(+))
- * _ | Normal acquisition mode
- *
- * @param xyz_data : the vector xyz output
- * @param v_overflow_s8 : the value of overflow
- * @param v_temp_correction_u8 : the value of temperate correction enable
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yas532_measurement_xyz_data(
- struct yas532_vector *xyz_data, u8 *v_overflow_s8, u8 v_temp_correction_u8,
- u8 v_acquisition_command_u8)
- {
- /* This variable used for provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array holding the linear calculation output*/
- s32 v_xy1y2_linear_s32[ARRAY_SIZE_THREE] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- /* Array holding the temperature data */
- s32 v_xyz_tmp_s32[ARRAY_SIZE_THREE] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- s32 tmp = C_BMI160_ZERO_U8X;
- s32 sx, sy1, sy2, sy, sz = C_BMI160_ZERO_U8X;
- u8 i, v_busy_u8 = C_BMI160_ZERO_U8X;
- u16 v_temp_u16 = C_BMI160_ZERO_U8X;
- /* Array holding the xyy1 sensor raw data*/
- u16 v_xy1y2_u16[ARRAY_SIZE_THREE] = {C_BMI160_ZERO_U8X,
- C_BMI160_ZERO_U8X, C_BMI160_ZERO_U8X};
- #if 1 < YAS532_MAG_TEMPERATURE_LOG
- s32 sum = C_BMI160_ZERO_U8X;
- #endif
- *v_overflow_s8 = C_BMI160_ZERO_U8X;
- switch (yas532_data.measure_state) {
- case YAS532_MAG_STATE_INIT_COIL:
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_1_DATA);
- /* write Rcoil*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_HEX_0_0_DATA);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_RCOIL);
- p_bmi160->delay_msec(C_BMI160_TWENTY_U8X);
- if (!yas532_data.overflow && is_valid_offset(
- yas532_data.v_hard_offset_s8))
- yas532_data.measure_state = YAS532_MAG_STATE_NORMAL;
- break;
- case YAS532_MAG_STATE_MEASURE_OFFSET:
- com_rslt = bmi160_bst_yas532_magnetic_measure_set_offset();
- yas532_data.measure_state = YAS532_MAG_STATE_NORMAL;
- break;
- default:
- break;
- }
- /* Read sensor data*/
- com_rslt += bmi160_bst_yas532_normal_measurement_data(
- v_acquisition_command_u8, &v_busy_u8, &v_temp_u16,
- v_xy1y2_u16, v_overflow_s8);
- /* Calculate the linear data*/
- com_rslt += bmi160_bst_yas532_xy1y2_to_linear(v_xy1y2_u16,
- v_xy1y2_linear_s32);
- /* Calculate temperature correction */
- #if 1 < YAS532_MAG_TEMPERATURE_LOG
- yas532_data.temp_data.log[yas532_data.temp_data.idx++] =
- v_temp_u16;
- if (YAS532_MAG_TEMPERATURE_LOG <= yas532_data.temp_data.idx)
- yas532_data.temp_data.idx = C_BMI160_ZERO_U8X;
- yas532_data.temp_data.num++;
- if (YAS532_MAG_TEMPERATURE_LOG <= yas532_data.temp_data.num)
- yas532_data.temp_data.num = YAS532_MAG_TEMPERATURE_LOG;
- for (i = C_BMI160_ZERO_U8X; i < yas532_data.temp_data.num; i++)
- sum += yas532_data.temp_data.log[i];
- tmp = sum * C_BMI160_TEN_U8X / yas532_data.temp_data.num
- - YAS532_TEMP20DEGREE_TYPICAL * C_BMI160_TEN_U8X;
- #else
- tmp = (v_temp_u16 - YAS532_TEMP20DEGREE_TYPICAL)
- * C_BMI160_TEN_U8X;
- #endif
- sx = v_xy1y2_linear_s32[INDEX_ZERO];
- sy1 = v_xy1y2_linear_s32[INDEX_ONE];
- sy2 = v_xy1y2_linear_s32[INDEX_TWO];
- /* Temperature correction */
- if (v_temp_correction_u8) {
- sx -= (yas532_data.calib_yas532.cx * tmp)
- / C_BMI160_THOUSAND_U8X;
- sy1 -= (yas532_data.calib_yas532.cy1 * tmp)
- / C_BMI160_THOUSAND_U8X;
- sy2 -= (yas532_data.calib_yas532.cy2 * tmp)
- / C_BMI160_THOUSAND_U8X;
- }
- sy = sy1 - sy2;
- sz = -sy1 - sy2;
- #if 1
- xyz_data->yas532_vector_xyz[INDEX_ZERO] = yas532_data.calib_yas532.k *
- ((C_BMI160_HUNDRED_U8X * sx + yas532_data.calib_yas532.a2 * sy +
- yas532_data.calib_yas532.a3 * sz) / C_BMI160_TEN_U8X);
- xyz_data->yas532_vector_xyz[INDEX_ONE] = yas532_data.calib_yas532.k *
- ((yas532_data.calib_yas532.a4 * sx + yas532_data.calib_yas532.a5 * sy +
- yas532_data.calib_yas532.a6 * sz) / C_BMI160_TEN_U8X);
- xyz_data->yas532_vector_xyz[INDEX_TWO] = yas532_data.calib_yas532.k *
- ((yas532_data.calib_yas532.a7 * sx + yas532_data.calib_yas532.a8 * sy +
- yas532_data.calib_yas532.a9 * sz) / C_BMI160_TEN_U8X);
- if (yas532_data.transform != BMI160_NULL) {
- for (i = C_BMI160_ZERO_U8X; i < C_BMI160_THREE_U8X; i++) {
- v_xyz_tmp_s32[i] = yas532_data.transform[i
- * C_BMI160_THREE_U8X] *
- xyz_data->yas532_vector_xyz[INDEX_ZERO]
- + yas532_data.transform[i * C_BMI160_THREE_U8X
- + C_BMI160_ONE_U8X] *
- xyz_data->yas532_vector_xyz[INDEX_ONE]
- + yas532_data.transform[i * C_BMI160_THREE_U8X
- + C_BMI160_TWO_U8X] *
- xyz_data->yas532_vector_xyz[INDEX_TWO];
- }
- set_vector(xyz_data->yas532_vector_xyz, v_xyz_tmp_s32);
- }
- for (i = C_BMI160_ZERO_U8X; i < C_BMI160_THREE_U8X; i++) {
- xyz_data->yas532_vector_xyz[i] -=
- xyz_data->yas532_vector_xyz[i] % C_BMI160_TEN_U8X;
- if (*v_overflow_s8 & (C_BMI160_ONE_U8X
- << (i * C_BMI160_TWO_U8X)))
- xyz_data->yas532_vector_xyz[i] +=
- C_BMI160_ONE_U8X; /* set overflow */
- if (*v_overflow_s8 & (C_BMI160_ONE_U8X <<
- (i * C_BMI160_TWO_U8X + C_BMI160_ONE_U8X)))
- xyz_data->yas532_vector_xyz[i] +=
- C_BMI160_TWO_U8X; /* set underflow */
- }
- #else
- xyz_data->yas532_vector_xyz[INDEX_ZERO] = sx;
- xyz_data->yas532_vector_xyz[INDEX_ONE] = sy;
- xyz_data->yas532_vector_xyz[INDEX_TWO] = sz;
- #endif
- if (v_busy_u8)
- return com_rslt;
- if (C_BMI160_ZERO_U8X < *v_overflow_s8) {
- if (!yas532_data.overflow)
- yas532_data.overflow = C_BMI160_ONE_U8X;
- yas532_data.measure_state = YAS532_MAG_STATE_INIT_COIL;
- } else
- yas532_data.overflow = C_BMI160_ZERO_U8X;
- for (i = C_BMI160_ZERO_U8X; i < C_BMI160_THREE_U8X; i++)
- yas532_data.last_raw[i] = v_xy1y2_u16[i];
- yas532_data.last_raw[i] = v_temp_u16;
- return com_rslt;
- }
- /*!
- * @brief This function used for YAS532 write data acquisition
- * command register write
- * @param v_command_reg_data_u8 : the value of data acquisition
- * acquisition_command | operation
- * ---------------------|-------------------------
- * 0x17 | turn on the acquisition coil
- * - | set direction of the coil
- * _ | (x and y as minus(-))
- * _ | Deferred acquisition mode
- * 0x07 | turn on the acquisition coil
- * _ | set direction of the coil
- * _ | (x and y as minus(-))
- * _ | Normal acquisition mode
- * 0x11 | turn OFF the acquisition coil
- * _ | set direction of the coil
- * _ | (x and y as plus(+))
- * _ | Deferred acquisition mode
- * 0x01 | turn OFF the acquisition coil
- * _ | set direction of the coil
- * _ | (x and y as plus(+))
- * _ | Normal acquisition mode
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yas532_acquisition_command_register(
- u8 v_command_reg_data_u8)
- {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_HEX_0_1_DATA);
- com_rslt = bmi160_set_mag_write_data(v_command_reg_data_u8);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* YAMAHA YAS532-0x82*/
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_YAS532_COMMAND_REGISTER);
- p_bmi160->delay_msec(C_BMI160_FIVETY_U8X);
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_YAS532_DATA_REGISTER);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- if (p_bmi160->mag_manual_enable == BMI160_HEX_0_1_DATA)
- com_rslt += bmi160_set_mag_manual_enable(BMI160_HEX_0_0_DATA);
- return com_rslt;
- }
- /*!
- * @brief This function used write offset of YAS532
- *
- * @param p_offset_s8 : The value of offset to write
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yas532_set_offset(
- const s8 *p_offset_s8)
- {
- /* This variable used for provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- if (p_bmi160->mag_manual_enable != BMI160_HEX_0_1_DATA)
- com_rslt = bmi160_set_mag_manual_enable(BMI160_HEX_0_1_DATA);
- p_bmi160->delay_msec(C_BMI160_TWO_U8X);
- /* Write offset X data*/
- com_rslt = bmi160_set_mag_write_data(p_offset_s8[INDEX_ZERO]);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* YAS532 offset x write*/
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_OFFSET_X);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* Write offset Y data*/
- com_rslt = bmi160_set_mag_write_data(p_offset_s8[INDEX_ONE]);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* YAS532 offset y write*/
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_OFFSET_Y);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* Write offset Z data*/
- com_rslt = bmi160_set_mag_write_data(p_offset_s8[INDEX_TWO]);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- /* YAS532 offset z write*/
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_OFFSET_Z);
- p_bmi160->delay_msec(C_BMI160_ONE_U8X);
- set_vector(yas532_data.v_hard_offset_s8, p_offset_s8);
- if (p_bmi160->mag_manual_enable == BMI160_HEX_0_1_DATA)
- com_rslt = bmi160_set_mag_manual_enable(BMI160_HEX_0_0_DATA);
- return com_rslt;
- }
- /*!
- * @brief This function used for reading
- * bmi160_t structure
- *
- * @return the reference and values of bmi160_t
- *
- *
- */
- struct bmi160_t *bmi160_get_ptr(void)
- {
- return p_bmi160;
- }
|