| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347334833493350335133523353335433553356335733583359336033613362336333643365336633673368336933703371337233733374337533763377337833793380338133823383338433853386338733883389339033913392339333943395339633973398339934003401340234033404340534063407340834093410341134123413341434153416341734183419342034213422342334243425342634273428342934303431343234333434343534363437343834393440344134423443344434453446344734483449345034513452345334543455345634573458345934603461346234633464346534663467346834693470347134723473347434753476347734783479348034813482348334843485348634873488348934903491349234933494349534963497349834993500350135023503350435053506350735083509351035113512351335143515351635173518351935203521352235233524352535263527352835293530353135323533353435353536353735383539354035413542354335443545354635473548354935503551355235533554355535563557355835593560356135623563356435653566356735683569357035713572357335743575357635773578357935803581358235833584358535863587358835893590359135923593359435953596359735983599360036013602360336043605360636073608360936103611361236133614361536163617361836193620362136223623362436253626362736283629363036313632363336343635363636373638363936403641364236433644364536463647364836493650365136523653365436553656365736583659366036613662366336643665366636673668366936703671367236733674367536763677367836793680368136823683368436853686368736883689369036913692369336943695369636973698369937003701370237033704370537063707370837093710371137123713371437153716371737183719372037213722372337243725372637273728372937303731373237333734373537363737373837393740374137423743374437453746374737483749375037513752375337543755375637573758375937603761376237633764376537663767376837693770377137723773377437753776377737783779378037813782378337843785378637873788378937903791379237933794379537963797379837993800380138023803380438053806380738083809381038113812381338143815381638173818381938203821382238233824382538263827382838293830383138323833383438353836383738383839384038413842384338443845384638473848384938503851385238533854385538563857385838593860386138623863386438653866386738683869387038713872387338743875387638773878387938803881388238833884388538863887388838893890389138923893389438953896389738983899390039013902390339043905390639073908390939103911391239133914391539163917391839193920392139223923392439253926392739283929393039313932393339343935393639373938393939403941394239433944394539463947394839493950395139523953395439553956395739583959396039613962396339643965396639673968396939703971397239733974397539763977397839793980398139823983398439853986398739883989399039913992399339943995399639973998399940004001400240034004400540064007400840094010401140124013401440154016401740184019402040214022402340244025402640274028402940304031403240334034403540364037403840394040404140424043404440454046404740484049405040514052405340544055405640574058405940604061406240634064406540664067406840694070407140724073407440754076407740784079408040814082408340844085408640874088408940904091409240934094409540964097409840994100410141024103410441054106410741084109411041114112411341144115411641174118411941204121412241234124412541264127412841294130413141324133413441354136413741384139414041414142414341444145414641474148414941504151415241534154415541564157415841594160416141624163416441654166416741684169417041714172417341744175417641774178417941804181418241834184418541864187418841894190419141924193419441954196419741984199420042014202420342044205420642074208420942104211421242134214421542164217421842194220422142224223422442254226422742284229423042314232423342344235423642374238423942404241424242434244424542464247424842494250425142524253425442554256425742584259426042614262426342644265426642674268426942704271427242734274427542764277427842794280428142824283428442854286428742884289429042914292429342944295429642974298429943004301430243034304430543064307430843094310431143124313431443154316431743184319432043214322432343244325432643274328432943304331433243334334433543364337433843394340434143424343434443454346434743484349435043514352435343544355435643574358435943604361436243634364436543664367436843694370437143724373437443754376437743784379438043814382438343844385438643874388438943904391439243934394439543964397439843994400440144024403440444054406440744084409441044114412441344144415441644174418441944204421442244234424442544264427442844294430443144324433443444354436443744384439444044414442444344444445444644474448444944504451445244534454445544564457445844594460446144624463446444654466446744684469447044714472447344744475447644774478447944804481448244834484448544864487448844894490449144924493449444954496449744984499450045014502450345044505450645074508450945104511451245134514451545164517451845194520452145224523452445254526452745284529453045314532453345344535453645374538453945404541454245434544454545464547454845494550455145524553455445554556455745584559456045614562456345644565456645674568456945704571457245734574457545764577457845794580458145824583458445854586458745884589459045914592459345944595459645974598459946004601460246034604460546064607460846094610461146124613461446154616461746184619462046214622462346244625462646274628462946304631463246334634463546364637463846394640464146424643464446454646464746484649465046514652465346544655465646574658465946604661466246634664466546664667466846694670467146724673467446754676467746784679468046814682468346844685468646874688468946904691469246934694469546964697469846994700470147024703470447054706470747084709471047114712471347144715471647174718471947204721472247234724472547264727472847294730473147324733473447354736473747384739474047414742474347444745474647474748474947504751475247534754475547564757475847594760476147624763476447654766476747684769477047714772477347744775477647774778477947804781478247834784478547864787478847894790479147924793479447954796479747984799480048014802480348044805480648074808480948104811481248134814481548164817481848194820482148224823482448254826482748284829483048314832483348344835483648374838483948404841484248434844484548464847484848494850485148524853485448554856485748584859486048614862486348644865486648674868486948704871487248734874487548764877487848794880488148824883488448854886488748884889489048914892489348944895489648974898489949004901490249034904490549064907490849094910491149124913491449154916491749184919492049214922492349244925492649274928492949304931493249334934493549364937493849394940494149424943494449454946494749484949495049514952495349544955495649574958495949604961496249634964496549664967496849694970497149724973497449754976497749784979498049814982498349844985498649874988498949904991499249934994499549964997499849995000500150025003500450055006500750085009501050115012501350145015501650175018501950205021502250235024502550265027502850295030503150325033503450355036503750385039504050415042504350445045504650475048504950505051505250535054505550565057505850595060506150625063506450655066506750685069507050715072507350745075507650775078507950805081508250835084508550865087508850895090509150925093509450955096509750985099510051015102510351045105510651075108510951105111511251135114511551165117511851195120512151225123512451255126512751285129513051315132513351345135513651375138513951405141514251435144514551465147514851495150515151525153515451555156515751585159516051615162516351645165516651675168516951705171517251735174517551765177517851795180518151825183518451855186518751885189519051915192519351945195519651975198519952005201520252035204520552065207520852095210521152125213521452155216521752185219522052215222522352245225522652275228522952305231523252335234523552365237523852395240524152425243524452455246524752485249525052515252525352545255525652575258525952605261526252635264526552665267526852695270527152725273527452755276527752785279528052815282528352845285528652875288528952905291529252935294529552965297529852995300530153025303530453055306530753085309531053115312531353145315531653175318531953205321532253235324532553265327532853295330533153325333533453355336533753385339534053415342534353445345534653475348534953505351535253535354535553565357535853595360536153625363536453655366536753685369537053715372537353745375537653775378537953805381538253835384538553865387538853895390539153925393539453955396539753985399540054015402540354045405540654075408540954105411541254135414541554165417541854195420542154225423542454255426542754285429543054315432543354345435543654375438543954405441544254435444544554465447544854495450545154525453545454555456545754585459546054615462546354645465546654675468546954705471547254735474547554765477547854795480548154825483548454855486548754885489549054915492549354945495549654975498549955005501550255035504550555065507550855095510551155125513551455155516551755185519552055215522552355245525552655275528552955305531553255335534553555365537553855395540554155425543554455455546554755485549555055515552555355545555555655575558555955605561556255635564556555665567556855695570557155725573557455755576557755785579558055815582558355845585558655875588558955905591559255935594559555965597559855995600560156025603560456055606560756085609561056115612561356145615561656175618561956205621562256235624562556265627562856295630563156325633563456355636563756385639564056415642564356445645564656475648564956505651565256535654565556565657565856595660566156625663566456655666566756685669567056715672567356745675567656775678567956805681568256835684568556865687568856895690569156925693569456955696569756985699570057015702570357045705570657075708570957105711571257135714571557165717571857195720572157225723572457255726572757285729573057315732573357345735573657375738573957405741574257435744574557465747574857495750575157525753575457555756575757585759576057615762576357645765576657675768576957705771577257735774577557765777577857795780578157825783578457855786578757885789579057915792579357945795579657975798579958005801580258035804580558065807580858095810581158125813581458155816581758185819582058215822582358245825582658275828582958305831583258335834583558365837583858395840584158425843584458455846584758485849585058515852585358545855585658575858585958605861586258635864586558665867586858695870587158725873587458755876587758785879588058815882588358845885588658875888588958905891589258935894589558965897589858995900590159025903590459055906590759085909591059115912591359145915591659175918591959205921592259235924592559265927592859295930593159325933593459355936593759385939594059415942594359445945594659475948594959505951595259535954595559565957595859595960596159625963596459655966596759685969597059715972597359745975597659775978597959805981598259835984598559865987598859895990599159925993599459955996599759985999600060016002600360046005600660076008600960106011601260136014601560166017601860196020602160226023602460256026602760286029603060316032603360346035603660376038603960406041604260436044604560466047604860496050605160526053605460556056605760586059606060616062606360646065606660676068606960706071607260736074607560766077607860796080608160826083608460856086608760886089609060916092609360946095609660976098609961006101610261036104610561066107610861096110611161126113611461156116611761186119612061216122612361246125612661276128612961306131613261336134613561366137613861396140614161426143614461456146614761486149615061516152615361546155615661576158615961606161616261636164616561666167616861696170617161726173617461756176617761786179618061816182618361846185618661876188618961906191619261936194619561966197619861996200620162026203620462056206620762086209621062116212621362146215621662176218621962206221622262236224622562266227622862296230623162326233623462356236623762386239624062416242624362446245624662476248624962506251625262536254625562566257625862596260626162626263626462656266626762686269627062716272627362746275627662776278627962806281628262836284628562866287628862896290629162926293629462956296629762986299630063016302630363046305630663076308630963106311631263136314631563166317631863196320632163226323632463256326632763286329633063316332633363346335633663376338633963406341634263436344634563466347634863496350635163526353635463556356635763586359636063616362636363646365636663676368636963706371637263736374637563766377637863796380638163826383638463856386638763886389639063916392639363946395639663976398639964006401640264036404640564066407640864096410641164126413641464156416641764186419642064216422642364246425642664276428642964306431643264336434643564366437643864396440644164426443644464456446644764486449645064516452645364546455645664576458645964606461646264636464646564666467646864696470647164726473647464756476647764786479648064816482648364846485648664876488648964906491649264936494649564966497649864996500650165026503650465056506650765086509651065116512651365146515651665176518651965206521652265236524652565266527652865296530653165326533653465356536653765386539654065416542654365446545654665476548654965506551655265536554655565566557655865596560656165626563656465656566656765686569657065716572657365746575657665776578657965806581658265836584658565866587658865896590659165926593659465956596659765986599660066016602660366046605660666076608660966106611661266136614661566166617661866196620662166226623662466256626662766286629663066316632663366346635663666376638663966406641664266436644664566466647664866496650665166526653665466556656665766586659666066616662666366646665666666676668666966706671667266736674667566766677667866796680668166826683668466856686668766886689669066916692669366946695669666976698669967006701670267036704670567066707670867096710671167126713671467156716671767186719672067216722672367246725672667276728672967306731673267336734673567366737673867396740674167426743674467456746674767486749675067516752675367546755675667576758675967606761676267636764676567666767676867696770677167726773677467756776677767786779678067816782678367846785678667876788678967906791679267936794679567966797679867996800680168026803680468056806680768086809681068116812681368146815681668176818681968206821682268236824682568266827682868296830683168326833683468356836683768386839684068416842684368446845684668476848684968506851685268536854685568566857685868596860686168626863686468656866686768686869687068716872687368746875687668776878687968806881688268836884688568866887688868896890689168926893689468956896689768986899690069016902690369046905690669076908690969106911691269136914691569166917691869196920692169226923692469256926692769286929693069316932693369346935693669376938693969406941694269436944694569466947694869496950695169526953695469556956695769586959696069616962696369646965696669676968696969706971697269736974697569766977697869796980698169826983698469856986698769886989699069916992699369946995699669976998699970007001700270037004700570067007700870097010701170127013701470157016701770187019702070217022702370247025702670277028702970307031703270337034703570367037703870397040704170427043704470457046704770487049705070517052705370547055705670577058705970607061706270637064706570667067706870697070707170727073707470757076707770787079708070817082708370847085708670877088708970907091709270937094709570967097709870997100710171027103710471057106710771087109711071117112711371147115711671177118711971207121712271237124712571267127712871297130713171327133713471357136713771387139714071417142714371447145714671477148714971507151715271537154715571567157715871597160716171627163716471657166716771687169717071717172717371747175717671777178717971807181718271837184718571867187718871897190719171927193719471957196719771987199720072017202720372047205720672077208720972107211721272137214721572167217721872197220722172227223722472257226722772287229723072317232723372347235723672377238723972407241724272437244724572467247724872497250725172527253725472557256725772587259726072617262726372647265726672677268726972707271727272737274727572767277727872797280728172827283728472857286728772887289729072917292729372947295729672977298729973007301730273037304730573067307730873097310731173127313731473157316731773187319732073217322732373247325732673277328732973307331733273337334733573367337733873397340734173427343734473457346734773487349735073517352735373547355735673577358735973607361736273637364736573667367736873697370737173727373737473757376737773787379738073817382738373847385738673877388738973907391739273937394739573967397739873997400740174027403740474057406740774087409741074117412741374147415741674177418741974207421742274237424742574267427742874297430743174327433743474357436743774387439744074417442744374447445744674477448744974507451745274537454745574567457745874597460746174627463746474657466746774687469747074717472747374747475747674777478747974807481748274837484748574867487748874897490749174927493749474957496749774987499750075017502750375047505750675077508750975107511751275137514751575167517751875197520752175227523752475257526752775287529753075317532753375347535753675377538753975407541754275437544754575467547754875497550755175527553755475557556755775587559756075617562756375647565756675677568756975707571757275737574757575767577757875797580758175827583758475857586758775887589759075917592759375947595759675977598759976007601760276037604760576067607760876097610761176127613761476157616761776187619762076217622762376247625762676277628762976307631763276337634763576367637763876397640764176427643764476457646764776487649765076517652765376547655765676577658765976607661766276637664766576667667766876697670767176727673767476757676767776787679768076817682768376847685768676877688768976907691769276937694769576967697769876997700770177027703770477057706770777087709771077117712771377147715771677177718771977207721772277237724772577267727772877297730773177327733773477357736773777387739774077417742774377447745774677477748774977507751775277537754775577567757775877597760776177627763776477657766776777687769777077717772777377747775777677777778777977807781778277837784778577867787778877897790779177927793779477957796779777987799780078017802780378047805780678077808780978107811781278137814781578167817781878197820782178227823782478257826782778287829783078317832783378347835783678377838783978407841784278437844784578467847784878497850785178527853785478557856785778587859786078617862786378647865786678677868786978707871787278737874787578767877787878797880788178827883788478857886788778887889789078917892789378947895789678977898789979007901790279037904790579067907790879097910791179127913791479157916791779187919792079217922792379247925792679277928792979307931793279337934793579367937793879397940794179427943794479457946794779487949795079517952795379547955795679577958795979607961796279637964796579667967796879697970797179727973797479757976797779787979798079817982798379847985798679877988798979907991799279937994799579967997799879998000800180028003800480058006800780088009801080118012801380148015801680178018801980208021802280238024802580268027802880298030803180328033803480358036803780388039804080418042804380448045804680478048804980508051805280538054805580568057805880598060806180628063806480658066806780688069807080718072807380748075807680778078807980808081808280838084808580868087808880898090809180928093809480958096809780988099810081018102810381048105810681078108810981108111811281138114811581168117811881198120812181228123812481258126812781288129813081318132813381348135813681378138813981408141814281438144814581468147814881498150815181528153815481558156815781588159816081618162816381648165816681678168816981708171817281738174817581768177817881798180818181828183818481858186818781888189819081918192819381948195819681978198819982008201820282038204820582068207820882098210821182128213821482158216821782188219822082218222822382248225822682278228822982308231823282338234823582368237823882398240824182428243824482458246824782488249825082518252825382548255825682578258825982608261826282638264826582668267826882698270827182728273827482758276827782788279828082818282828382848285828682878288828982908291829282938294829582968297829882998300830183028303830483058306830783088309831083118312831383148315831683178318831983208321832283238324832583268327832883298330833183328333833483358336833783388339834083418342834383448345834683478348834983508351835283538354835583568357835883598360836183628363836483658366836783688369837083718372837383748375837683778378837983808381838283838384838583868387838883898390839183928393839483958396839783988399840084018402840384048405840684078408840984108411841284138414841584168417841884198420842184228423842484258426842784288429843084318432843384348435843684378438843984408441844284438444844584468447844884498450845184528453845484558456845784588459846084618462846384648465846684678468846984708471847284738474847584768477847884798480848184828483848484858486848784888489849084918492849384948495849684978498849985008501850285038504850585068507850885098510851185128513851485158516851785188519852085218522852385248525852685278528852985308531853285338534853585368537853885398540854185428543854485458546854785488549855085518552855385548555855685578558855985608561856285638564856585668567856885698570857185728573857485758576857785788579858085818582858385848585858685878588858985908591859285938594859585968597859885998600860186028603860486058606860786088609861086118612861386148615861686178618861986208621862286238624862586268627862886298630863186328633863486358636863786388639864086418642864386448645864686478648864986508651865286538654865586568657865886598660866186628663866486658666866786688669867086718672867386748675867686778678867986808681868286838684868586868687868886898690869186928693869486958696869786988699870087018702870387048705870687078708870987108711871287138714871587168717871887198720872187228723872487258726872787288729873087318732873387348735873687378738873987408741874287438744874587468747874887498750875187528753875487558756875787588759876087618762876387648765876687678768876987708771877287738774877587768777877887798780878187828783878487858786878787888789879087918792879387948795879687978798879988008801880288038804880588068807880888098810881188128813881488158816881788188819882088218822882388248825882688278828882988308831883288338834883588368837883888398840884188428843884488458846884788488849885088518852885388548855885688578858885988608861886288638864886588668867886888698870887188728873887488758876887788788879888088818882888388848885888688878888888988908891889288938894889588968897889888998900890189028903890489058906890789088909891089118912891389148915891689178918891989208921892289238924892589268927892889298930893189328933893489358936893789388939894089418942894389448945894689478948894989508951895289538954895589568957895889598960896189628963896489658966896789688969897089718972897389748975897689778978897989808981898289838984898589868987898889898990899189928993899489958996899789988999900090019002900390049005900690079008900990109011901290139014901590169017901890199020902190229023902490259026902790289029903090319032903390349035903690379038903990409041904290439044904590469047904890499050905190529053905490559056905790589059906090619062906390649065906690679068906990709071907290739074907590769077907890799080908190829083908490859086908790889089909090919092909390949095909690979098909991009101910291039104910591069107910891099110911191129113911491159116911791189119912091219122912391249125912691279128912991309131913291339134913591369137913891399140914191429143914491459146914791489149915091519152915391549155915691579158915991609161916291639164916591669167916891699170917191729173917491759176917791789179918091819182918391849185918691879188918991909191919291939194919591969197919891999200920192029203920492059206920792089209921092119212921392149215921692179218921992209221922292239224922592269227922892299230923192329233923492359236923792389239924092419242924392449245924692479248924992509251925292539254925592569257925892599260926192629263926492659266926792689269927092719272927392749275927692779278927992809281928292839284928592869287928892899290929192929293929492959296929792989299930093019302930393049305930693079308930993109311931293139314931593169317931893199320932193229323932493259326932793289329933093319332933393349335933693379338933993409341934293439344934593469347934893499350935193529353935493559356935793589359936093619362936393649365936693679368936993709371937293739374937593769377937893799380938193829383938493859386938793889389939093919392939393949395939693979398939994009401940294039404940594069407940894099410941194129413941494159416941794189419942094219422942394249425942694279428942994309431943294339434943594369437943894399440944194429443944494459446944794489449945094519452945394549455945694579458945994609461946294639464946594669467946894699470947194729473947494759476947794789479948094819482948394849485948694879488948994909491949294939494949594969497949894999500950195029503950495059506950795089509951095119512951395149515951695179518951995209521952295239524952595269527952895299530953195329533953495359536953795389539954095419542954395449545954695479548954995509551955295539554955595569557955895599560956195629563956495659566956795689569957095719572957395749575957695779578957995809581958295839584958595869587958895899590959195929593959495959596959795989599960096019602960396049605960696079608960996109611961296139614961596169617961896199620962196229623962496259626962796289629963096319632963396349635963696379638963996409641964296439644964596469647964896499650965196529653965496559656965796589659966096619662966396649665966696679668966996709671967296739674967596769677967896799680968196829683968496859686968796889689969096919692969396949695969696979698969997009701970297039704970597069707970897099710971197129713971497159716971797189719972097219722972397249725972697279728972997309731973297339734973597369737973897399740974197429743974497459746974797489749975097519752975397549755975697579758975997609761976297639764976597669767976897699770977197729773977497759776977797789779978097819782978397849785978697879788978997909791979297939794979597969797979897999800980198029803980498059806980798089809981098119812981398149815981698179818981998209821982298239824982598269827982898299830983198329833983498359836983798389839984098419842984398449845984698479848984998509851985298539854985598569857985898599860986198629863986498659866986798689869987098719872987398749875987698779878987998809881988298839884988598869887988898899890989198929893989498959896989798989899990099019902990399049905990699079908990999109911991299139914991599169917991899199920992199229923992499259926992799289929993099319932993399349935993699379938993999409941994299439944994599469947994899499950995199529953995499559956995799589959996099619962996399649965996699679968996999709971997299739974997599769977997899799980998199829983998499859986998799889989999099919992999399949995999699979998999910000100011000210003100041000510006100071000810009100101001110012100131001410015100161001710018100191002010021100221002310024100251002610027100281002910030100311003210033100341003510036100371003810039100401004110042100431004410045100461004710048100491005010051100521005310054100551005610057100581005910060100611006210063100641006510066100671006810069100701007110072100731007410075100761007710078100791008010081100821008310084100851008610087100881008910090100911009210093100941009510096100971009810099101001010110102101031010410105101061010710108101091011010111101121011310114101151011610117101181011910120101211012210123101241012510126101271012810129101301013110132101331013410135101361013710138101391014010141101421014310144101451014610147101481014910150101511015210153101541015510156101571015810159101601016110162101631016410165101661016710168101691017010171101721017310174101751017610177101781017910180101811018210183101841018510186101871018810189101901019110192101931019410195101961019710198101991020010201102021020310204102051020610207102081020910210102111021210213102141021510216102171021810219102201022110222102231022410225102261022710228102291023010231102321023310234102351023610237102381023910240102411024210243102441024510246102471024810249102501025110252102531025410255102561025710258102591026010261102621026310264102651026610267102681026910270102711027210273102741027510276102771027810279102801028110282102831028410285102861028710288102891029010291102921029310294102951029610297102981029910300103011030210303103041030510306103071030810309103101031110312103131031410315103161031710318103191032010321103221032310324103251032610327103281032910330103311033210333103341033510336103371033810339103401034110342103431034410345103461034710348103491035010351103521035310354103551035610357103581035910360103611036210363103641036510366103671036810369103701037110372103731037410375103761037710378103791038010381103821038310384103851038610387103881038910390103911039210393103941039510396103971039810399104001040110402104031040410405104061040710408104091041010411104121041310414104151041610417104181041910420104211042210423104241042510426104271042810429104301043110432104331043410435104361043710438104391044010441104421044310444104451044610447104481044910450104511045210453104541045510456104571045810459104601046110462104631046410465104661046710468104691047010471104721047310474104751047610477104781047910480104811048210483104841048510486104871048810489104901049110492104931049410495104961049710498104991050010501105021050310504105051050610507105081050910510105111051210513105141051510516105171051810519105201052110522105231052410525105261052710528105291053010531105321053310534105351053610537105381053910540105411054210543105441054510546105471054810549105501055110552105531055410555105561055710558105591056010561105621056310564105651056610567105681056910570105711057210573105741057510576105771057810579105801058110582105831058410585105861058710588105891059010591105921059310594105951059610597105981059910600106011060210603106041060510606106071060810609106101061110612106131061410615106161061710618106191062010621106221062310624106251062610627106281062910630106311063210633106341063510636106371063810639106401064110642106431064410645106461064710648106491065010651106521065310654106551065610657106581065910660106611066210663106641066510666106671066810669106701067110672106731067410675106761067710678106791068010681106821068310684106851068610687106881068910690106911069210693106941069510696106971069810699107001070110702107031070410705107061070710708107091071010711107121071310714107151071610717107181071910720107211072210723107241072510726107271072810729107301073110732107331073410735107361073710738107391074010741107421074310744107451074610747107481074910750107511075210753107541075510756107571075810759107601076110762107631076410765107661076710768107691077010771107721077310774107751077610777107781077910780107811078210783107841078510786107871078810789107901079110792107931079410795107961079710798107991080010801108021080310804108051080610807108081080910810108111081210813108141081510816108171081810819108201082110822108231082410825108261082710828108291083010831108321083310834108351083610837108381083910840108411084210843108441084510846108471084810849108501085110852108531085410855108561085710858108591086010861108621086310864108651086610867108681086910870108711087210873108741087510876108771087810879108801088110882108831088410885108861088710888108891089010891108921089310894108951089610897108981089910900109011090210903109041090510906109071090810909109101091110912109131091410915109161091710918109191092010921109221092310924109251092610927109281092910930109311093210933109341093510936109371093810939109401094110942109431094410945109461094710948109491095010951109521095310954109551095610957109581095910960109611096210963109641096510966109671096810969109701097110972109731097410975109761097710978109791098010981109821098310984109851098610987109881098910990109911099210993109941099510996109971099810999110001100111002110031100411005110061100711008110091101011011110121101311014110151101611017110181101911020110211102211023110241102511026110271102811029110301103111032110331103411035110361103711038110391104011041110421104311044110451104611047110481104911050110511105211053110541105511056110571105811059110601106111062110631106411065110661106711068110691107011071110721107311074110751107611077110781107911080110811108211083110841108511086110871108811089110901109111092110931109411095110961109711098110991110011101111021110311104111051110611107111081110911110111111111211113111141111511116111171111811119111201112111122111231112411125111261112711128111291113011131111321113311134111351113611137111381113911140111411114211143111441114511146111471114811149111501115111152111531115411155111561115711158111591116011161111621116311164111651116611167111681116911170111711117211173111741117511176111771117811179111801118111182111831118411185111861118711188111891119011191111921119311194111951119611197111981119911200112011120211203112041120511206112071120811209112101121111212112131121411215112161121711218112191122011221112221122311224112251122611227112281122911230112311123211233112341123511236112371123811239112401124111242112431124411245112461124711248112491125011251112521125311254112551125611257112581125911260112611126211263112641126511266112671126811269112701127111272112731127411275112761127711278112791128011281112821128311284112851128611287112881128911290112911129211293112941129511296112971129811299113001130111302113031130411305113061130711308113091131011311113121131311314113151131611317113181131911320113211132211323113241132511326113271132811329113301133111332113331133411335113361133711338113391134011341113421134311344113451134611347113481134911350113511135211353113541135511356113571135811359113601136111362113631136411365113661136711368113691137011371113721137311374113751137611377113781137911380113811138211383113841138511386113871138811389113901139111392113931139411395113961139711398113991140011401114021140311404114051140611407114081140911410114111141211413114141141511416114171141811419114201142111422114231142411425114261142711428114291143011431114321143311434114351143611437114381143911440114411144211443114441144511446114471144811449114501145111452114531145411455114561145711458114591146011461114621146311464114651146611467114681146911470114711147211473114741147511476114771147811479114801148111482114831148411485114861148711488114891149011491114921149311494114951149611497114981149911500115011150211503115041150511506115071150811509115101151111512115131151411515115161151711518115191152011521115221152311524115251152611527115281152911530115311153211533115341153511536115371153811539115401154111542115431154411545115461154711548115491155011551115521155311554115551155611557115581155911560115611156211563115641156511566115671156811569115701157111572115731157411575115761157711578115791158011581115821158311584115851158611587115881158911590115911159211593115941159511596115971159811599116001160111602116031160411605116061160711608116091161011611116121161311614116151161611617116181161911620116211162211623116241162511626116271162811629116301163111632116331163411635116361163711638116391164011641116421164311644116451164611647116481164911650116511165211653116541165511656116571165811659116601166111662116631166411665116661166711668116691167011671116721167311674116751167611677116781167911680116811168211683116841168511686116871168811689116901169111692116931169411695116961169711698116991170011701117021170311704117051170611707117081170911710117111171211713117141171511716117171171811719117201172111722117231172411725117261172711728117291173011731117321173311734117351173611737117381173911740117411174211743117441174511746117471174811749117501175111752117531175411755117561175711758117591176011761117621176311764117651176611767117681176911770117711177211773117741177511776117771177811779117801178111782117831178411785117861178711788117891179011791117921179311794117951179611797117981179911800118011180211803118041180511806118071180811809118101181111812118131181411815118161181711818118191182011821118221182311824118251182611827118281182911830118311183211833118341183511836118371183811839118401184111842118431184411845118461184711848118491185011851118521185311854118551185611857118581185911860118611186211863118641186511866118671186811869118701187111872118731187411875118761187711878118791188011881118821188311884118851188611887118881188911890118911189211893118941189511896118971189811899119001190111902119031190411905119061190711908119091191011911119121191311914119151191611917119181191911920119211192211923119241192511926119271192811929119301193111932119331193411935119361193711938119391194011941119421194311944119451194611947119481194911950119511195211953119541195511956119571195811959119601196111962119631196411965119661196711968119691197011971119721197311974119751197611977119781197911980119811198211983119841198511986119871198811989119901199111992119931199411995119961199711998119991200012001120021200312004120051200612007120081200912010120111201212013120141201512016120171201812019120201202112022120231202412025120261202712028120291203012031120321203312034120351203612037120381203912040120411204212043120441204512046120471204812049120501205112052120531205412055120561205712058120591206012061120621206312064120651206612067120681206912070120711207212073120741207512076120771207812079120801208112082120831208412085120861208712088120891209012091120921209312094120951209612097120981209912100121011210212103121041210512106121071210812109121101211112112121131211412115121161211712118121191212012121121221212312124121251212612127121281212912130121311213212133121341213512136121371213812139121401214112142121431214412145121461214712148121491215012151121521215312154121551215612157121581215912160121611216212163121641216512166121671216812169121701217112172121731217412175121761217712178121791218012181121821218312184121851218612187121881218912190121911219212193121941219512196121971219812199122001220112202122031220412205122061220712208122091221012211122121221312214122151221612217122181221912220122211222212223122241222512226122271222812229122301223112232122331223412235122361223712238122391224012241122421224312244122451224612247122481224912250122511225212253122541225512256122571225812259122601226112262122631226412265122661226712268122691227012271122721227312274122751227612277122781227912280122811228212283122841228512286122871228812289122901229112292122931229412295122961229712298122991230012301123021230312304123051230612307123081230912310123111231212313123141231512316123171231812319123201232112322123231232412325123261232712328123291233012331123321233312334123351233612337123381233912340123411234212343123441234512346123471234812349123501235112352123531235412355123561235712358123591236012361123621236312364123651236612367123681236912370123711237212373123741237512376123771237812379123801238112382123831238412385123861238712388123891239012391123921239312394123951239612397123981239912400124011240212403124041240512406124071240812409124101241112412124131241412415124161241712418124191242012421124221242312424124251242612427124281242912430124311243212433124341243512436124371243812439124401244112442124431244412445124461244712448124491245012451124521245312454124551245612457124581245912460124611246212463124641246512466124671246812469124701247112472124731247412475124761247712478124791248012481124821248312484124851248612487124881248912490124911249212493124941249512496124971249812499125001250112502125031250412505125061250712508125091251012511125121251312514125151251612517125181251912520125211252212523125241252512526125271252812529125301253112532125331253412535125361253712538125391254012541125421254312544125451254612547125481254912550125511255212553125541255512556125571255812559125601256112562125631256412565125661256712568125691257012571125721257312574125751257612577125781257912580125811258212583125841258512586125871258812589125901259112592125931259412595125961259712598125991260012601126021260312604126051260612607126081260912610126111261212613126141261512616126171261812619126201262112622126231262412625126261262712628126291263012631126321263312634126351263612637126381263912640126411264212643126441264512646126471264812649126501265112652126531265412655126561265712658126591266012661126621266312664126651266612667126681266912670126711267212673126741267512676126771267812679126801268112682126831268412685126861268712688126891269012691126921269312694126951269612697126981269912700127011270212703127041270512706127071270812709127101271112712127131271412715127161271712718127191272012721127221272312724127251272612727127281272912730127311273212733127341273512736127371273812739127401274112742127431274412745127461274712748127491275012751127521275312754127551275612757127581275912760127611276212763127641276512766127671276812769127701277112772127731277412775127761277712778127791278012781127821278312784127851278612787127881278912790127911279212793127941279512796127971279812799128001280112802128031280412805128061280712808128091281012811128121281312814128151281612817128181281912820128211282212823128241282512826128271282812829128301283112832128331283412835128361283712838128391284012841128421284312844128451284612847128481284912850128511285212853128541285512856128571285812859128601286112862128631286412865128661286712868128691287012871128721287312874128751287612877128781287912880128811288212883128841288512886128871288812889128901289112892128931289412895128961289712898128991290012901129021290312904129051290612907129081290912910129111291212913129141291512916129171291812919129201292112922129231292412925129261292712928129291293012931129321293312934129351293612937129381293912940129411294212943129441294512946129471294812949129501295112952129531295412955129561295712958129591296012961129621296312964129651296612967129681296912970129711297212973129741297512976129771297812979129801298112982129831298412985129861298712988129891299012991129921299312994129951299612997129981299913000130011300213003130041300513006130071300813009130101301113012130131301413015130161301713018130191302013021130221302313024130251302613027130281302913030130311303213033130341303513036130371303813039130401304113042130431304413045130461304713048130491305013051130521305313054130551305613057130581305913060130611306213063130641306513066130671306813069130701307113072130731307413075130761307713078130791308013081130821308313084130851308613087130881308913090130911309213093130941309513096130971309813099131001310113102131031310413105131061310713108131091311013111131121311313114131151311613117131181311913120131211312213123131241312513126131271312813129131301313113132131331313413135131361313713138131391314013141131421314313144131451314613147131481314913150131511315213153131541315513156131571315813159131601316113162131631316413165131661316713168131691317013171131721317313174131751317613177131781317913180131811318213183131841318513186131871318813189131901319113192131931319413195131961319713198131991320013201132021320313204132051320613207132081320913210132111321213213132141321513216132171321813219132201322113222132231322413225132261322713228132291323013231132321323313234132351323613237132381323913240132411324213243132441324513246132471324813249132501325113252132531325413255132561325713258132591326013261132621326313264132651326613267132681326913270132711327213273132741327513276132771327813279132801328113282132831328413285132861328713288132891329013291132921329313294132951329613297132981329913300133011330213303133041330513306133071330813309133101331113312133131331413315133161331713318133191332013321133221332313324133251332613327133281332913330133311333213333133341333513336133371333813339133401334113342133431334413345133461334713348133491335013351133521335313354133551335613357133581335913360133611336213363133641336513366133671336813369133701337113372133731337413375133761337713378133791338013381133821338313384133851338613387133881338913390133911339213393133941339513396133971339813399134001340113402134031340413405134061340713408134091341013411134121341313414134151341613417134181341913420134211342213423134241342513426134271342813429134301343113432134331343413435134361343713438134391344013441134421344313444134451344613447134481344913450134511345213453134541345513456134571345813459134601346113462134631346413465134661346713468134691347013471134721347313474134751347613477134781347913480134811348213483134841348513486134871348813489134901349113492134931349413495134961349713498134991350013501135021350313504135051350613507135081350913510135111351213513135141351513516135171351813519135201352113522135231352413525135261352713528135291353013531135321353313534135351353613537135381353913540135411354213543135441354513546135471354813549135501355113552135531355413555135561355713558135591356013561135621356313564135651356613567135681356913570135711357213573135741357513576135771357813579135801358113582135831358413585135861358713588135891359013591135921359313594135951359613597135981359913600136011360213603136041360513606136071360813609136101361113612136131361413615136161361713618136191362013621136221362313624136251362613627136281362913630136311363213633136341363513636136371363813639136401364113642136431364413645136461364713648136491365013651136521365313654136551365613657136581365913660136611366213663136641366513666136671366813669136701367113672136731367413675136761367713678136791368013681136821368313684136851368613687136881368913690136911369213693136941369513696136971369813699137001370113702137031370413705137061370713708137091371013711137121371313714137151371613717137181371913720137211372213723137241372513726137271372813729137301373113732137331373413735137361373713738137391374013741137421374313744137451374613747137481374913750137511375213753137541375513756137571375813759137601376113762137631376413765137661376713768137691377013771137721377313774137751377613777137781377913780137811378213783137841378513786137871378813789137901379113792137931379413795137961379713798137991380013801138021380313804138051380613807138081380913810138111381213813138141381513816138171381813819138201382113822138231382413825138261382713828138291383013831138321383313834138351383613837138381383913840138411384213843138441384513846138471384813849138501385113852138531385413855138561385713858138591386013861138621386313864138651386613867138681386913870138711387213873138741387513876138771387813879138801388113882138831388413885138861388713888138891389013891138921389313894138951389613897138981389913900139011390213903139041390513906139071390813909139101391113912139131391413915139161391713918139191392013921139221392313924139251392613927139281392913930139311393213933139341393513936139371393813939139401394113942139431394413945139461394713948139491395013951139521395313954139551395613957139581395913960139611396213963139641396513966139671396813969139701397113972139731397413975139761397713978139791398013981139821398313984139851398613987139881398913990139911399213993139941399513996139971399813999140001400114002140031400414005140061400714008140091401014011140121401314014140151401614017140181401914020140211402214023140241402514026140271402814029140301403114032140331403414035140361403714038140391404014041140421404314044140451404614047140481404914050140511405214053140541405514056140571405814059140601406114062140631406414065140661406714068140691407014071140721407314074140751407614077140781407914080140811408214083140841408514086140871408814089140901409114092140931409414095140961409714098140991410014101141021410314104141051410614107141081410914110141111411214113141141411514116141171411814119141201412114122141231412414125141261412714128141291413014131141321413314134141351413614137141381413914140141411414214143141441414514146141471414814149141501415114152141531415414155141561415714158141591416014161141621416314164141651416614167141681416914170141711417214173141741417514176141771417814179141801418114182141831418414185141861418714188141891419014191141921419314194141951419614197141981419914200142011420214203142041420514206142071420814209142101421114212142131421414215142161421714218142191422014221142221422314224142251422614227142281422914230142311423214233142341423514236142371423814239142401424114242142431424414245142461424714248142491425014251142521425314254142551425614257142581425914260142611426214263142641426514266142671426814269142701427114272142731427414275142761427714278142791428014281142821428314284142851428614287142881428914290142911429214293142941429514296142971429814299143001430114302143031430414305143061430714308143091431014311143121431314314143151431614317143181431914320143211432214323143241432514326143271432814329143301433114332143331433414335143361433714338143391434014341143421434314344143451434614347143481434914350143511435214353143541435514356143571435814359143601436114362143631436414365143661436714368143691437014371143721437314374143751437614377143781437914380143811438214383143841438514386143871438814389143901439114392143931439414395143961439714398143991440014401144021440314404144051440614407144081440914410144111441214413144141441514416144171441814419144201442114422144231442414425144261442714428144291443014431144321443314434144351443614437144381443914440144411444214443144441444514446144471444814449144501445114452144531445414455144561445714458144591446014461144621446314464144651446614467144681446914470144711447214473144741447514476144771447814479144801448114482144831448414485144861448714488144891449014491144921449314494144951449614497144981449914500145011450214503145041450514506145071450814509145101451114512145131451414515145161451714518145191452014521145221452314524145251452614527145281452914530145311453214533145341453514536145371453814539145401454114542145431454414545145461454714548145491455014551145521455314554145551455614557145581455914560145611456214563145641456514566145671456814569145701457114572145731457414575145761457714578145791458014581145821458314584145851458614587145881458914590145911459214593145941459514596145971459814599146001460114602146031460414605146061460714608146091461014611146121461314614146151461614617146181461914620146211462214623146241462514626146271462814629146301463114632146331463414635146361463714638146391464014641146421464314644146451464614647146481464914650146511465214653146541465514656146571465814659146601466114662146631466414665146661466714668146691467014671146721467314674146751467614677146781467914680146811468214683146841468514686146871468814689146901469114692146931469414695146961469714698146991470014701147021470314704147051470614707147081470914710147111471214713147141471514716147171471814719147201472114722147231472414725147261472714728147291473014731147321473314734147351473614737147381473914740147411474214743147441474514746147471474814749147501475114752147531475414755147561475714758147591476014761147621476314764147651476614767147681476914770147711477214773147741477514776147771477814779147801478114782147831478414785147861478714788147891479014791147921479314794147951479614797147981479914800148011480214803148041480514806148071480814809148101481114812148131481414815148161481714818148191482014821148221482314824148251482614827148281482914830148311483214833148341483514836148371483814839148401484114842148431484414845148461484714848148491485014851148521485314854148551485614857148581485914860148611486214863148641486514866148671486814869148701487114872148731487414875148761487714878148791488014881148821488314884148851488614887148881488914890148911489214893148941489514896148971489814899149001490114902149031490414905149061490714908149091491014911149121491314914149151491614917149181491914920149211492214923149241492514926149271492814929149301493114932149331493414935149361493714938149391494014941149421494314944149451494614947149481494914950149511495214953149541495514956149571495814959149601496114962149631496414965149661496714968149691497014971149721497314974149751497614977149781497914980149811498214983149841498514986149871498814989149901499114992149931499414995149961499714998149991500015001150021500315004150051500615007150081500915010150111501215013150141501515016150171501815019150201502115022150231502415025150261502715028150291503015031150321503315034150351503615037150381503915040150411504215043150441504515046150471504815049150501505115052150531505415055150561505715058150591506015061150621506315064150651506615067150681506915070150711507215073150741507515076150771507815079150801508115082150831508415085150861508715088150891509015091150921509315094150951509615097150981509915100151011510215103151041510515106151071510815109151101511115112151131511415115151161511715118151191512015121151221512315124151251512615127151281512915130151311513215133151341513515136151371513815139151401514115142151431514415145151461514715148151491515015151151521515315154151551515615157151581515915160151611516215163151641516515166151671516815169151701517115172151731517415175151761517715178151791518015181151821518315184151851518615187151881518915190151911519215193151941519515196151971519815199152001520115202152031520415205152061520715208152091521015211152121521315214152151521615217152181521915220152211522215223152241522515226152271522815229152301523115232152331523415235152361523715238152391524015241152421524315244152451524615247152481524915250152511525215253152541525515256152571525815259152601526115262152631526415265152661526715268152691527015271152721527315274152751527615277152781527915280152811528215283152841528515286152871528815289152901529115292152931529415295152961529715298152991530015301153021530315304153051530615307153081530915310153111531215313153141531515316153171531815319153201532115322153231532415325153261532715328153291533015331153321533315334153351533615337153381533915340153411534215343153441534515346153471534815349153501535115352153531535415355153561535715358153591536015361153621536315364153651536615367153681536915370153711537215373153741537515376153771537815379153801538115382153831538415385153861538715388153891539015391153921539315394153951539615397153981539915400154011540215403154041540515406154071540815409154101541115412154131541415415154161541715418154191542015421154221542315424154251542615427154281542915430154311543215433154341543515436154371543815439154401544115442154431544415445154461544715448154491545015451154521545315454154551545615457154581545915460154611546215463154641546515466154671546815469154701547115472154731547415475154761547715478154791548015481154821548315484154851548615487154881548915490154911549215493154941549515496154971549815499155001550115502155031550415505155061550715508155091551015511155121551315514155151551615517155181551915520155211552215523155241552515526155271552815529155301553115532155331553415535155361553715538155391554015541155421554315544155451554615547155481554915550155511555215553155541555515556155571555815559155601556115562155631556415565155661556715568155691557015571155721557315574155751557615577155781557915580155811558215583155841558515586155871558815589155901559115592155931559415595155961559715598155991560015601156021560315604156051560615607156081560915610156111561215613156141561515616156171561815619156201562115622156231562415625156261562715628156291563015631156321563315634156351563615637156381563915640156411564215643156441564515646156471564815649156501565115652156531565415655156561565715658156591566015661156621566315664156651566615667156681566915670156711567215673156741567515676156771567815679156801568115682156831568415685156861568715688156891569015691156921569315694156951569615697156981569915700157011570215703157041570515706157071570815709157101571115712157131571415715157161571715718157191572015721157221572315724157251572615727157281572915730157311573215733157341573515736157371573815739157401574115742157431574415745157461574715748157491575015751157521575315754157551575615757157581575915760157611576215763157641576515766157671576815769157701577115772157731577415775157761577715778157791578015781157821578315784157851578615787157881578915790157911579215793157941579515796157971579815799158001580115802158031580415805158061580715808158091581015811158121581315814158151581615817158181581915820158211582215823158241582515826158271582815829158301583115832158331583415835158361583715838158391584015841158421584315844158451584615847158481584915850158511585215853158541585515856158571585815859158601586115862158631586415865158661586715868158691587015871158721587315874158751587615877158781587915880158811588215883158841588515886158871588815889158901589115892158931589415895158961589715898158991590015901159021590315904159051590615907159081590915910159111591215913159141591515916159171591815919159201592115922159231592415925159261592715928159291593015931159321593315934159351593615937159381593915940159411594215943159441594515946159471594815949159501595115952159531595415955159561595715958159591596015961159621596315964159651596615967159681596915970159711597215973159741597515976159771597815979159801598115982159831598415985159861598715988159891599015991159921599315994159951599615997159981599916000160011600216003160041600516006160071600816009160101601116012160131601416015160161601716018160191602016021160221602316024160251602616027160281602916030160311603216033160341603516036160371603816039160401604116042160431604416045160461604716048160491605016051160521605316054160551605616057160581605916060160611606216063160641606516066160671606816069160701607116072160731607416075160761607716078160791608016081160821608316084160851608616087160881608916090160911609216093160941609516096160971609816099161001610116102161031610416105161061610716108161091611016111161121611316114161151611616117161181611916120161211612216123161241612516126161271612816129161301613116132161331613416135161361613716138161391614016141161421614316144161451614616147161481614916150161511615216153161541615516156161571615816159161601616116162161631616416165161661616716168161691617016171161721617316174161751617616177161781617916180161811618216183161841618516186161871618816189161901619116192161931619416195161961619716198161991620016201162021620316204162051620616207162081620916210162111621216213162141621516216162171621816219162201622116222162231622416225162261622716228162291623016231162321623316234162351623616237162381623916240162411624216243162441624516246162471624816249162501625116252162531625416255162561625716258162591626016261162621626316264162651626616267162681626916270162711627216273162741627516276162771627816279162801628116282162831628416285162861628716288162891629016291162921629316294162951629616297162981629916300163011630216303163041630516306163071630816309163101631116312163131631416315163161631716318163191632016321163221632316324163251632616327163281632916330163311633216333163341633516336163371633816339163401634116342163431634416345163461634716348163491635016351163521635316354163551635616357163581635916360163611636216363163641636516366163671636816369163701637116372163731637416375163761637716378163791638016381163821638316384163851638616387163881638916390163911639216393163941639516396163971639816399164001640116402164031640416405164061640716408164091641016411164121641316414164151641616417164181641916420164211642216423164241642516426164271642816429164301643116432164331643416435164361643716438164391644016441164421644316444164451644616447164481644916450164511645216453164541645516456164571645816459164601646116462164631646416465164661646716468164691647016471164721647316474164751647616477164781647916480164811648216483164841648516486164871648816489164901649116492164931649416495164961649716498164991650016501165021650316504165051650616507165081650916510165111651216513165141651516516165171651816519165201652116522165231652416525165261652716528165291653016531165321653316534165351653616537165381653916540165411654216543165441654516546165471654816549165501655116552165531655416555165561655716558165591656016561165621656316564165651656616567165681656916570165711657216573165741657516576165771657816579165801658116582165831658416585165861658716588165891659016591165921659316594165951659616597165981659916600166011660216603166041660516606166071660816609166101661116612166131661416615166161661716618166191662016621166221662316624166251662616627166281662916630166311663216633166341663516636166371663816639166401664116642166431664416645166461664716648166491665016651166521665316654166551665616657166581665916660166611666216663166641666516666166671666816669166701667116672166731667416675166761667716678166791668016681166821668316684166851668616687166881668916690166911669216693166941669516696166971669816699167001670116702167031670416705167061670716708167091671016711167121671316714167151671616717167181671916720167211672216723167241672516726167271672816729167301673116732167331673416735167361673716738167391674016741167421674316744167451674616747167481674916750167511675216753167541675516756167571675816759167601676116762167631676416765167661676716768167691677016771167721677316774167751677616777167781677916780167811678216783167841678516786167871678816789167901679116792167931679416795167961679716798167991680016801168021680316804168051680616807168081680916810168111681216813168141681516816168171681816819168201682116822168231682416825168261682716828168291683016831168321683316834168351683616837168381683916840168411684216843168441684516846168471684816849168501685116852168531685416855168561685716858168591686016861168621686316864168651686616867168681686916870168711687216873168741687516876168771687816879168801688116882168831688416885168861688716888168891689016891168921689316894168951689616897168981689916900169011690216903169041690516906169071690816909169101691116912169131691416915169161691716918169191692016921169221692316924169251692616927169281692916930169311693216933169341693516936169371693816939169401694116942169431694416945169461694716948169491695016951169521695316954169551695616957169581695916960169611696216963169641696516966169671696816969169701697116972169731697416975169761697716978169791698016981169821698316984169851698616987169881698916990169911699216993169941699516996169971699816999170001700117002170031700417005170061700717008170091701017011170121701317014170151701617017170181701917020170211702217023170241702517026170271702817029170301703117032170331703417035170361703717038170391704017041170421704317044170451704617047170481704917050170511705217053170541705517056170571705817059170601706117062170631706417065170661706717068170691707017071170721707317074170751707617077170781707917080170811708217083170841708517086170871708817089170901709117092170931709417095170961709717098170991710017101171021710317104171051710617107171081710917110171111711217113171141711517116171171711817119171201712117122171231712417125171261712717128171291713017131171321713317134171351713617137171381713917140171411714217143171441714517146171471714817149171501715117152171531715417155171561715717158171591716017161171621716317164171651716617167171681716917170171711717217173171741717517176171771717817179171801718117182171831718417185171861718717188171891719017191171921719317194171951719617197171981719917200172011720217203172041720517206172071720817209172101721117212172131721417215172161721717218172191722017221172221722317224172251722617227172281722917230172311723217233172341723517236172371723817239172401724117242172431724417245172461724717248172491725017251172521725317254172551725617257172581725917260172611726217263172641726517266172671726817269172701727117272172731727417275172761727717278172791728017281172821728317284172851728617287172881728917290172911729217293172941729517296172971729817299173001730117302173031730417305173061730717308173091731017311173121731317314173151731617317173181731917320173211732217323173241732517326173271732817329173301733117332173331733417335173361733717338173391734017341173421734317344173451734617347173481734917350173511735217353173541735517356173571735817359173601736117362173631736417365173661736717368173691737017371173721737317374173751737617377173781737917380173811738217383173841738517386173871738817389173901739117392173931739417395173961739717398173991740017401174021740317404174051740617407174081740917410174111741217413174141741517416174171741817419174201742117422174231742417425174261742717428174291743017431174321743317434174351743617437174381743917440174411744217443174441744517446174471744817449174501745117452174531745417455174561745717458174591746017461174621746317464174651746617467174681746917470174711747217473174741747517476174771747817479174801748117482174831748417485174861748717488174891749017491174921749317494174951749617497174981749917500175011750217503175041750517506175071750817509175101751117512175131751417515175161751717518175191752017521175221752317524175251752617527175281752917530175311753217533175341753517536175371753817539175401754117542175431754417545175461754717548175491755017551175521755317554175551755617557175581755917560175611756217563175641756517566175671756817569175701757117572175731757417575175761757717578175791758017581175821758317584175851758617587175881758917590175911759217593175941759517596175971759817599176001760117602176031760417605176061760717608176091761017611176121761317614176151761617617176181761917620176211762217623176241762517626176271762817629176301763117632176331763417635176361763717638176391764017641176421764317644176451764617647176481764917650176511765217653176541765517656176571765817659176601766117662176631766417665176661766717668176691767017671176721767317674176751767617677176781767917680176811768217683176841768517686176871768817689176901769117692176931769417695176961769717698176991770017701177021770317704177051770617707177081770917710177111771217713177141771517716177171771817719177201772117722177231772417725177261772717728177291773017731177321773317734177351773617737177381773917740177411774217743177441774517746177471774817749177501775117752177531775417755177561775717758177591776017761177621776317764177651776617767177681776917770177711777217773177741777517776177771777817779177801778117782177831778417785177861778717788177891779017791177921779317794177951779617797177981779917800178011780217803178041780517806178071780817809178101781117812178131781417815178161781717818178191782017821178221782317824178251782617827178281782917830178311783217833178341783517836178371783817839178401784117842178431784417845178461784717848178491785017851178521785317854178551785617857178581785917860178611786217863178641786517866178671786817869178701787117872178731787417875178761787717878178791788017881178821788317884178851788617887178881788917890178911789217893178941789517896178971789817899179001790117902179031790417905179061790717908179091791017911179121791317914179151791617917179181791917920179211792217923179241792517926179271792817929179301793117932179331793417935179361793717938179391794017941179421794317944179451794617947179481794917950179511795217953179541795517956179571795817959179601796117962179631796417965179661796717968179691797017971179721797317974179751797617977179781797917980179811798217983179841798517986179871798817989179901799117992179931799417995179961799717998179991800018001180021800318004180051800618007180081800918010180111801218013180141801518016180171801818019180201802118022180231802418025180261802718028180291803018031180321803318034180351803618037180381803918040180411804218043180441804518046180471804818049180501805118052180531805418055180561805718058180591806018061180621806318064180651806618067180681806918070180711807218073180741807518076180771807818079180801808118082180831808418085180861808718088180891809018091180921809318094180951809618097180981809918100181011810218103181041810518106181071810818109181101811118112181131811418115181161811718118181191812018121181221812318124181251812618127181281812918130181311813218133181341813518136181371813818139181401814118142181431814418145181461814718148181491815018151181521815318154181551815618157181581815918160181611816218163181641816518166181671816818169181701817118172181731817418175181761817718178181791818018181181821818318184181851818618187181881818918190181911819218193181941819518196181971819818199182001820118202182031820418205182061820718208182091821018211182121821318214182151821618217182181821918220182211822218223182241822518226182271822818229182301823118232182331823418235182361823718238182391824018241182421824318244182451824618247182481824918250182511825218253182541825518256182571825818259182601826118262182631826418265182661826718268182691827018271182721827318274182751827618277182781827918280182811828218283182841828518286182871828818289182901829118292182931829418295182961829718298182991830018301183021830318304183051830618307183081830918310183111831218313183141831518316183171831818319183201832118322183231832418325183261832718328183291833018331183321833318334183351833618337183381833918340183411834218343183441834518346183471834818349183501835118352183531835418355183561835718358183591836018361183621836318364183651836618367183681836918370183711837218373183741837518376183771837818379183801838118382183831838418385183861838718388183891839018391183921839318394183951839618397183981839918400184011840218403184041840518406184071840818409184101841118412184131841418415184161841718418184191842018421184221842318424184251842618427184281842918430184311843218433184341843518436184371843818439184401844118442184431844418445184461844718448184491845018451184521845318454184551845618457184581845918460184611846218463184641846518466184671846818469184701847118472184731847418475184761847718478184791848018481184821848318484184851848618487184881848918490184911849218493184941849518496184971849818499185001850118502185031850418505185061850718508185091851018511185121851318514185151851618517185181851918520185211852218523185241852518526185271852818529185301853118532185331853418535185361853718538185391854018541185421854318544185451854618547185481854918550185511855218553185541855518556185571855818559185601856118562185631856418565185661856718568185691857018571185721857318574185751857618577185781857918580185811858218583185841858518586185871858818589185901859118592185931859418595185961859718598185991860018601186021860318604186051860618607186081860918610186111861218613186141861518616186171861818619186201862118622186231862418625186261862718628186291863018631186321863318634186351863618637186381863918640186411864218643186441864518646186471864818649186501865118652186531865418655186561865718658186591866018661186621866318664186651866618667186681866918670186711867218673186741867518676186771867818679186801868118682186831868418685186861868718688186891869018691186921869318694186951869618697186981869918700187011870218703187041870518706187071870818709187101871118712187131871418715187161871718718187191872018721187221872318724187251872618727187281872918730187311873218733187341873518736187371873818739187401874118742187431874418745187461874718748187491875018751187521875318754187551875618757187581875918760187611876218763187641876518766187671876818769187701877118772187731877418775187761877718778187791878018781187821878318784187851878618787187881878918790187911879218793187941879518796187971879818799188001880118802188031880418805188061880718808188091881018811188121881318814188151881618817188181881918820188211882218823188241882518826188271882818829188301883118832188331883418835188361883718838188391884018841188421884318844188451884618847188481884918850188511885218853188541885518856188571885818859188601886118862188631886418865188661886718868188691887018871188721887318874188751887618877188781887918880188811888218883188841888518886188871888818889188901889118892188931889418895188961889718898188991890018901189021890318904189051890618907189081890918910189111891218913189141891518916189171891818919189201892118922189231892418925189261892718928189291893018931189321893318934189351893618937189381893918940189411894218943189441894518946189471894818949189501895118952189531895418955189561895718958189591896018961189621896318964189651896618967189681896918970189711897218973189741897518976189771897818979189801898118982189831898418985189861898718988189891899018991189921899318994189951899618997189981899919000190011900219003190041900519006190071900819009190101901119012190131901419015190161901719018190191902019021190221902319024190251902619027190281902919030190311903219033190341903519036190371903819039190401904119042190431904419045190461904719048190491905019051190521905319054190551905619057190581905919060190611906219063190641906519066190671906819069190701907119072190731907419075190761907719078190791908019081190821908319084190851908619087190881908919090190911909219093190941909519096190971909819099191001910119102191031910419105191061910719108191091911019111191121911319114191151911619117191181911919120191211912219123191241912519126191271912819129191301913119132191331913419135191361913719138191391914019141191421914319144191451914619147191481914919150191511915219153191541915519156191571915819159191601916119162191631916419165191661916719168191691917019171191721917319174191751917619177191781917919180191811918219183191841918519186191871918819189191901919119192191931919419195191961919719198191991920019201192021920319204192051920619207192081920919210192111921219213192141921519216192171921819219192201922119222192231922419225192261922719228192291923019231192321923319234192351923619237192381923919240192411924219243192441924519246192471924819249192501925119252192531925419255192561925719258192591926019261192621926319264192651926619267192681926919270192711927219273192741927519276192771927819279192801928119282192831928419285192861928719288192891929019291192921929319294192951929619297192981929919300193011930219303193041930519306193071930819309193101931119312193131931419315193161931719318193191932019321193221932319324193251932619327193281932919330193311933219333193341933519336193371933819339193401934119342193431934419345193461934719348193491935019351193521935319354193551935619357193581935919360193611936219363193641936519366193671936819369193701937119372193731937419375193761937719378193791938019381193821938319384193851938619387193881938919390193911939219393193941939519396193971939819399194001940119402194031940419405194061940719408194091941019411194121941319414194151941619417194181941919420194211942219423194241942519426194271942819429194301943119432194331943419435194361943719438194391944019441194421944319444194451944619447194481944919450194511945219453194541945519456194571945819459194601946119462194631946419465194661946719468194691947019471194721947319474194751947619477194781947919480194811948219483194841948519486194871948819489194901949119492194931949419495194961949719498194991950019501195021950319504195051950619507195081950919510195111951219513195141951519516195171951819519195201952119522195231952419525195261952719528195291953019531195321953319534195351953619537195381953919540195411954219543195441954519546195471954819549195501955119552195531955419555195561955719558195591956019561195621956319564195651956619567195681956919570195711957219573195741957519576195771957819579195801958119582195831958419585195861958719588195891959019591195921959319594195951959619597195981959919600196011960219603196041960519606196071960819609196101961119612196131961419615196161961719618196191962019621196221962319624196251962619627196281962919630196311963219633196341963519636196371963819639196401964119642196431964419645196461964719648196491965019651196521965319654196551965619657196581965919660196611966219663196641966519666196671966819669196701967119672196731967419675196761967719678196791968019681196821968319684196851968619687196881968919690196911969219693196941969519696196971969819699197001970119702197031970419705197061970719708197091971019711197121971319714197151971619717197181971919720197211972219723197241972519726197271972819729197301973119732197331973419735197361973719738197391974019741197421974319744197451974619747197481974919750197511975219753197541975519756197571975819759197601976119762197631976419765197661976719768197691977019771197721977319774197751977619777197781977919780197811978219783197841978519786197871978819789197901979119792197931979419795197961979719798197991980019801198021980319804198051980619807198081980919810198111981219813198141981519816198171981819819198201982119822198231982419825198261982719828198291983019831198321983319834198351983619837198381983919840198411984219843198441984519846198471984819849198501985119852198531985419855198561985719858198591986019861198621986319864198651986619867198681986919870198711987219873198741987519876198771987819879198801988119882198831988419885198861988719888198891989019891198921989319894198951989619897198981989919900199011990219903199041990519906199071990819909199101991119912199131991419915199161991719918199191992019921199221992319924199251992619927199281992919930199311993219933199341993519936199371993819939199401994119942199431994419945199461994719948199491995019951199521995319954199551995619957199581995919960199611996219963199641996519966199671996819969199701997119972199731997419975199761997719978199791998019981199821998319984199851998619987199881998919990199911999219993199941999519996199971999819999200002000120002200032000420005200062000720008200092001020011200122001320014200152001620017200182001920020200212002220023200242002520026200272002820029200302003120032200332003420035200362003720038200392004020041200422004320044200452004620047200482004920050200512005220053200542005520056200572005820059200602006120062200632006420065200662006720068200692007020071200722007320074200752007620077200782007920080200812008220083200842008520086200872008820089200902009120092200932009420095200962009720098200992010020101201022010320104201052010620107201082010920110201112011220113201142011520116201172011820119201202012120122201232012420125201262012720128201292013020131201322013320134201352013620137201382013920140201412014220143201442014520146201472014820149201502015120152201532015420155201562015720158201592016020161201622016320164201652016620167201682016920170201712017220173201742017520176201772017820179201802018120182201832018420185201862018720188201892019020191201922019320194201952019620197201982019920200202012020220203202042020520206202072020820209202102021120212202132021420215202162021720218202192022020221202222022320224202252022620227202282022920230202312023220233202342023520236202372023820239202402024120242202432024420245202462024720248202492025020251202522025320254202552025620257202582025920260202612026220263202642026520266202672026820269202702027120272202732027420275202762027720278202792028020281202822028320284202852028620287202882028920290202912029220293202942029520296202972029820299203002030120302203032030420305203062030720308203092031020311203122031320314203152031620317203182031920320203212032220323203242032520326203272032820329203302033120332203332033420335203362033720338203392034020341203422034320344203452034620347203482034920350203512035220353203542035520356203572035820359203602036120362203632036420365203662036720368203692037020371203722037320374203752037620377203782037920380203812038220383203842038520386203872038820389203902039120392203932039420395203962039720398203992040020401204022040320404204052040620407204082040920410204112041220413204142041520416204172041820419204202042120422204232042420425204262042720428204292043020431204322043320434204352043620437204382043920440204412044220443204442044520446204472044820449204502045120452204532045420455204562045720458204592046020461204622046320464204652046620467204682046920470204712047220473204742047520476204772047820479204802048120482204832048420485204862048720488204892049020491204922049320494204952049620497204982049920500205012050220503205042050520506205072050820509205102051120512205132051420515205162051720518205192052020521205222052320524205252052620527205282052920530205312053220533205342053520536205372053820539205402054120542205432054420545205462054720548205492055020551205522055320554205552055620557205582055920560205612056220563205642056520566205672056820569205702057120572205732057420575205762057720578205792058020581205822058320584205852058620587205882058920590205912059220593205942059520596205972059820599206002060120602206032060420605206062060720608206092061020611206122061320614206152061620617206182061920620206212062220623206242062520626206272062820629206302063120632206332063420635206362063720638206392064020641206422064320644206452064620647206482064920650206512065220653206542065520656206572065820659206602066120662206632066420665206662066720668206692067020671206722067320674206752067620677206782067920680206812068220683206842068520686206872068820689206902069120692206932069420695206962069720698206992070020701207022070320704207052070620707207082070920710207112071220713207142071520716207172071820719207202072120722207232072420725207262072720728207292073020731207322073320734207352073620737207382073920740207412074220743207442074520746207472074820749207502075120752207532075420755207562075720758207592076020761207622076320764207652076620767207682076920770207712077220773207742077520776207772077820779207802078120782207832078420785207862078720788207892079020791 |
- /*
- ****************************************************************************
- * Copyright (C) 2016 Bosch Sensortec GmbH
- *
- * bmi160.c
- * Date: 2016/06/27
- * Revision: 2.2.1 $
- *
- * 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"
- struct bmi160_t *p_bmi160;
- /* Used for reading the Mag trim values for compensation*/
- struct trim_data_t mag_trim;
- /* the following variable is used for avoiding the selecting of auto mode
- when it is running in the manual mode of BMM150 Mag interface*/
- u8 bmm150_manual_auto_condition_u8_g;
- /*Power mode monitoring variable used to introduce delays after primary
- interface write in low power and suspend modes of sensor */
- u8 bmi160_power_mode_status_u8_g;
- /* FIFO data read for 1024 bytes of data */
- #ifdef FIFO_ENABLE
- static u8 v_fifo_data_u8[FIFO_FRAME];
- struct bmi160_mag_fifo_data_t mag_data;
- #endif
- /* YAMAHA-YAS532*/
- /* value of coefficient*/
- #ifdef YAS532
- 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*/
- struct yas532_t yas532_data;
- struct yas532_vector fifo_xyz_data;
- #endif
- #ifdef YAS537
- /* used for reading the yas537 calibration data*/
- struct yas537_t yas537_data;
- struct yas_vector fifo_vector_xyz;
- /*!
- * @brief This function is used to process the
- * YAMAHA YAS537 xy1y2 raw data
- *
- * @param xy1y2: The value of raw xy1y2 data
- * @param xyz: The value of xyz data
- *
- *
- * @return None
- *
- *
- */
- static void xy1y2_to_xyz(u16 *xy1y2, s32 *xyz);
- /*!
- * @brief This function is used to detect whether the mag
- * data obtained is valid or not
- *
- *
- * @param v_cur_u16: The value of current Mag data
- * @param v_last_u16: The value of last Mag data
- *
- *
- * @return result of magnetic field data's validity
- * @retval 0 -> VALID DATA
- * @retval 1 -> INVALID DATA
- *
- *
- */
- static BMI160_RETURN_FUNCTION_TYPE invalid_magnetic_field(
- u16 *v_cur_u16, u16 *v_last_u16);
- #endif
- #if defined AKM09911 || defined AKM09912
- /* used to read the AKM compensating data */
- struct bst_akm_sensitivity_data_t akm_asa_data;
- #endif
- struct bmi160_mag_xyz_s32_t processed_data;
- /*!
- * @brief
- * This API is used to 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 of bmi160 instance
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- * @note
- * While changing the parameter of the bmi160_t
- * consider the following points:
- * Changing the reference value of the parameter
- * will change the local copy or local reference
- * make sure your changes will not
- * affect the reference value of the parameter
- * (Better don't change the reference value of the parameter)
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_init(struct bmi160_t *bmi160)
- {
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 v_pmu_data_u8 = BMI160_INIT_VALUE;
- /* assign bmi160 pointer */
- p_bmi160 = bmi160;
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_CHIP_ID__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* store the chip id which is read from the sensor */
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- return com_rslt;
- }
- /*!
- * @brief
- * This API writes the data to
- * the given register
- *
- *
- * @param v_addr_u8 -> Address of the register
- * @param v_data_u8 -> The data to write to the register
- * @param v_len_u8 -> no of bytes to write
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 read 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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 is used to read 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read the fatal error status*/
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FATAL_ERR__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_fatal_err_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FATAL_ERR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is 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 (Gyro 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 is 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 dropped 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_drop_cmd_err_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_DROP_CMD_ERR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the Mag data ready
- * error interrupt
- * It reads from the error register 0x02 bit 7
- *
- *
- *
- *
- * @param v_mag_data_rdy_err_u8 : The status of Mag data ready error interrupt
- *
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_get_mag_data_rdy_err(
- u8 *v_mag_data_rdy_err_u8)
- {
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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_DATA_RDY_ERR__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_mag_data_rdy_err_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_DATA_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_err_u8 : 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_err_u8,
- 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* fatal error*/
- *v_fatal_err_u8 =
- 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_DATA_RDY_ERR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the Mag 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 is set by the 0x7E command register
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 Gyro 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 is set by the 0x7E command register
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 Accel 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 is set by the 0x7E command register
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_accel_power_mode_stat_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_POWER_MODE_STAT);
- }
- return com_rslt;
- }
- /*!
- * @brief This API switches the Mag interface to normal mode
- * and confirm whether the mode switching is done successfully or not
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_set_mag_interface_normal(void)
- {
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = BMI160_INIT_VALUE;
- /* aim to check the result of switching Mag normal */
- u8 v_try_times_u8 = BMI160_MAG_NORMAL_SWITCH_TIMES;
- u8 v_mag_pmu_status_u8 = BMI160_INIT_VALUE;
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt = bmi160_set_command_register(MAG_MODE_NORMAL);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- while (v_try_times_u8 != 0) {
- com_rslt = bmi160_get_mag_power_mode_stat(&v_mag_pmu_status_u8);
- if (v_mag_pmu_status_u8 == MAG_INTERFACE_PMU_ENABLE)
- break;
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- v_try_times_u8--;
- }
- if (v_mag_pmu_status_u8 == MAG_INTERFACE_PMU_ENABLE)
- com_rslt += SUCCESS;
- else
- com_rslt += E_BMI160_COMM_RES;
- return com_rslt;
- }
- /*!
- * @brief This API reads Mag data X values
- * from the register 0x04 and 0x05
- * @brief The Mag sensor data read from 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 or AKM09912
- *
- * @note For Mag output data rate configuration use the following function
- * 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 to 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[BMI160_MAG_X_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_MAG_X_DATA_LENGTH);
- /* X axis*/
- v_data_u8[BMI160_MAG_X_LSB_BYTE] =
- BMI160_GET_BITSLICE(v_data_u8[BMI160_MAG_X_LSB_BYTE],
- BMI160_USER_DATA_MAG_X_LSB);
- *v_mag_x_s16 = (s16)
- ((((s32)((s8)v_data_u8[BMI160_MAG_X_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_05_BITS) |
- (v_data_u8[BMI160_MAG_X_LSB_BYTE]));
- 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, BMI160_MAG_X_DATA_LENGTH);
- *v_mag_x_s16 = (s16)
- ((((s32)((s8)v_data_u8[BMI160_MAG_X_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) |
- (v_data_u8[BMI160_MAG_X_LSB_BYTE]));
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads Mag data Y values
- * from the register 0x06 and 0x07
- * @brief The Mag sensor data read from 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 or AKM09912
- *
- * @note For Mag output data rate configuration use the following function
- * 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[BMI160_MAG_Y_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_MAG_Y_DATA_LENGTH);
- /*Y-axis LSB value shifting*/
- v_data_u8[BMI160_MAG_Y_LSB_BYTE] =
- BMI160_GET_BITSLICE(v_data_u8[BMI160_MAG_Y_LSB_BYTE],
- BMI160_USER_DATA_MAG_Y_LSB);
- *v_mag_y_s16 = (s16)
- ((((s32)((s8)v_data_u8[BMI160_MAG_Y_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_05_BITS) |
- (v_data_u8[BMI160_MAG_Y_LSB_BYTE]));
- 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, BMI160_MAG_Y_DATA_LENGTH);
- *v_mag_y_s16 = (s16)
- ((((s32)((s8)v_data_u8[BMI160_MAG_Y_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) |
- (v_data_u8[BMI160_MAG_Y_LSB_BYTE]));
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads Mag data Z values
- * from the register 0x08 and 0x09
- * @brief The Mag sensor data read from 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 or AKM09912
- *
- * @note For Mag output data rate configuration use the following function
- * 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 to 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[BMI160_MAG_Z_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_MAG_Z_DATA_LENGTH);
- /*Z-axis LSB value shifting*/
- v_data_u8[BMI160_MAG_Z_LSB_BYTE] =
- BMI160_GET_BITSLICE(v_data_u8[BMI160_MAG_Z_LSB_BYTE],
- BMI160_USER_DATA_MAG_Z_LSB);
- *v_mag_z_s16 = (s16)
- ((((s32)((s8)v_data_u8[BMI160_MAG_Z_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_07_BITS) |
- (v_data_u8[BMI160_MAG_Z_LSB_BYTE]));
- 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, BMI160_MAG_Z_DATA_LENGTH);
- *v_mag_z_s16 = (s16)
- ((((s32)((s8)v_data_u8[BMI160_MAG_Z_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) | (
- v_data_u8[BMI160_MAG_Z_LSB_BYTE]));
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads Mag 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 to 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[BMI160_MAG_R_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_MAG_R_DATA_LENGTH);
- /*R-axis LSB value shifting*/
- v_data_u8[BMI160_MAG_R_LSB_BYTE] =
- BMI160_GET_BITSLICE(v_data_u8[BMI160_MAG_R_LSB_BYTE],
- BMI160_USER_DATA_MAG_R_LSB);
- *v_mag_r_s16 = (s16)
- ((((s32)((s8)v_data_u8[BMI160_MAG_R_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_06_BITS) |
- (v_data_u8[BMI160_MAG_R_LSB_BYTE]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads Mag data X,Y,Z values
- * from the register 0x04 to 0x09
- *
- * @brief The Mag sensor data read from auxiliary mag
- *
- * @param Mag : The value of Mag xyz data
- * @param v_sensor_select_u8 : Mag selection value
- * value | sensor
- * ---------|----------------
- * 0 | BMM150
- * 1 | AKM09911 or AKM09912
- *
- * @note For Mag output data 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 to 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[BMI160_MAG_XYZ_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_MAG_XYZ_DATA_LENGTH);
- /*X-axis LSB value shifting*/
- v_data_u8[BMI160_DATA_FRAME_MAG_X_LSB_BYTE] =
- BMI160_GET_BITSLICE(
- v_data_u8[BMI160_DATA_FRAME_MAG_X_LSB_BYTE],
- BMI160_USER_DATA_MAG_X_LSB);
- /* Data X */
- mag->x = (s16)
- ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_MAG_X_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_05_BITS) |
- (v_data_u8[BMI160_DATA_FRAME_MAG_X_LSB_BYTE]));
- /* Data Y */
- /*Y-axis LSB value shifting*/
- v_data_u8[BMI160_DATA_FRAME_MAG_Y_LSB_BYTE] =
- BMI160_GET_BITSLICE(
- v_data_u8[BMI160_DATA_FRAME_MAG_Y_LSB_BYTE],
- BMI160_USER_DATA_MAG_Y_LSB);
- mag->y = (s16)
- ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_MAG_Y_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_05_BITS) |
- (v_data_u8[BMI160_DATA_FRAME_MAG_Y_LSB_BYTE]));
- /* Data Z */
- /*Z-axis LSB value shifting*/
- v_data_u8[BMI160_DATA_FRAME_MAG_Z_LSB_BYTE]
- = BMI160_GET_BITSLICE(
- v_data_u8[BMI160_DATA_FRAME_MAG_Z_LSB_BYTE],
- BMI160_USER_DATA_MAG_Z_LSB);
- mag->z = (s16)
- ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_MAG_Z_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_07_BITS) |
- (v_data_u8[BMI160_DATA_FRAME_MAG_Z_LSB_BYTE]));
- 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, BMI160_MAG_XYZ_DATA_LENGTH);
- /* Data X */
- mag->x = (s16)
- ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_MAG_X_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) |
- (v_data_u8[BMI160_DATA_FRAME_MAG_X_LSB_BYTE]));
- /* Data Y */
- mag->y = ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_MAG_Y_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) |
- (v_data_u8[BMI160_DATA_FRAME_MAG_Y_LSB_BYTE]));
- /* Data Z */
- mag->z = (s16)
- ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_MAG_Z_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) |
- (v_data_u8[BMI160_DATA_FRAME_MAG_Z_LSB_BYTE]));
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!*
- * @brief This API reads Mag data X,Y,Z,r
- * values from the register 0x04 to 0x0B.
- *
- * @brief The Mag sensor data read from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8[BMI160_MAG_XYZR_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_MAG_XYZR_DATA_LENGTH);
- /* Data X */
- /*X-axis LSB value shifting*/
- v_data_u8[BMI160_DATA_FRAME_MAG_X_LSB_BYTE]
- = BMI160_GET_BITSLICE(
- v_data_u8[BMI160_DATA_FRAME_MAG_X_LSB_BYTE],
- BMI160_USER_DATA_MAG_X_LSB);
- mag->x = (s16)
- ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_MAG_X_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_05_BITS)
- | (v_data_u8[BMI160_DATA_FRAME_MAG_X_LSB_BYTE]));
- /* Data Y */
- /*Y-axis LSB value shifting*/
- v_data_u8[BMI160_DATA_FRAME_MAG_Y_LSB_BYTE]
- = BMI160_GET_BITSLICE(
- v_data_u8[BMI160_DATA_FRAME_MAG_Y_LSB_BYTE],
- BMI160_USER_DATA_MAG_Y_LSB);
- mag->y = (s16)
- ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_MAG_Y_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_05_BITS)
- | (v_data_u8[
- BMI160_DATA_FRAME_MAG_Y_LSB_BYTE]));
- /* Data Z */
- /*Z-axis LSB value shifting*/
- v_data_u8[BMI160_DATA_FRAME_MAG_Z_LSB_BYTE]
- = BMI160_GET_BITSLICE(
- v_data_u8[BMI160_DATA_FRAME_MAG_Z_LSB_BYTE],
- BMI160_USER_DATA_MAG_Z_LSB);
- mag->z = (s16)
- ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_MAG_Z_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_07_BITS)
- | (v_data_u8[BMI160_DATA_FRAME_MAG_Z_LSB_BYTE]));
- /* RHall */
- /*R-axis LSB value shifting*/
- v_data_u8[BMI160_DATA_FRAME_MAG_R_LSB_BYTE]
- = BMI160_GET_BITSLICE(
- v_data_u8[BMI160_DATA_FRAME_MAG_R_LSB_BYTE],
- BMI160_USER_DATA_MAG_R_LSB);
- mag->r = (s16)
- ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_MAG_R_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_06_BITS)
- | (v_data_u8[BMI160_DATA_FRAME_MAG_R_LSB_BYTE]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads gyro data X values
- * from the register 0x0C and 0x0D.
- *
- * @param v_gyro_x_s16 : The value of gyro x data.
- *
- * @note Gyro configuration use the following functions.
- * @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 to 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[BMI160_GYRO_X_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GYRO_DATA_LENGTH);
- *v_gyro_x_s16 = (s16)
- ((((s32)((s8)v_data_u8[BMI160_GYRO_X_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_data_u8[BMI160_GYRO_X_LSB_BYTE]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads gyro data Y values
- * from 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 to 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[BMI160_GYRO_Y_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GYRO_DATA_LENGTH);
- *v_gyro_y_s16 = (s16)
- ((((s32)((s8)v_data_u8[BMI160_GYRO_Y_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_data_u8[BMI160_GYRO_Y_LSB_BYTE]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads gyro data Z values
- * from the register 0x10 and 0x11.
- *
- * @param v_gyro_z_s16 : The value of gyro z data.
- *
- * @note Gyro configuration use the following functions.
- * @note bmi160_set_gyro_output_data_rate()
- * @note bmi160_set_gyro_bw()
- * @note bmi160_set_gyro_range()
- *
- * @return results of the bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_gyro_z(s16 *v_gyro_z_s16)
- {
- /* variable used to 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[BMI160_GYRO_Z_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GYRO_DATA_LENGTH);
- *v_gyro_z_s16 = (s16)
- ((((s32)((s8)v_data_u8[BMI160_GYRO_Z_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_data_u8[BMI160_GYRO_Z_LSB_BYTE]));
- }
- 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 functions.
- * @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 to 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[BMI160_GYRO_XYZ_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GYRO_XYZ_DATA_LENGTH);
- /* Data X */
- gyro->x = (s16)
- ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_GYRO_X_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_data_u8[BMI160_DATA_FRAME_GYRO_X_LSB_BYTE]));
- /* Data Y */
- gyro->y = (s16)
- ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_GYRO_Y_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_data_u8[BMI160_DATA_FRAME_GYRO_Y_LSB_BYTE]));
- /* Data Z */
- gyro->z = (s16)
- ((((s32)((s8)v_data_u8[
- BMI160_DATA_FRAME_GYRO_Z_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_data_u8[BMI160_DATA_FRAME_GYRO_Z_LSB_BYTE]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the Accel data for X axis
- * from the register 0x12 and 0x13.
- *
- * @param v_accel_x_s16 : The value of Accel x axis.
- *
- * @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 to 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[BMI160_ACCEL_X_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_ACCEL_DATA_LENGTH);
- *v_accel_x_s16 = (s16)
- ((((s32)((s8)v_data_u8[BMI160_ACCEL_X_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_data_u8[BMI160_ACCEL_X_LSB_BYTE]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads Accel data for Y axis
- * from the register 0x14 and 0x15.
- *
- * @param v_accel_y_s16 : The value of Accel y axis.
- *
- * @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 to 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[BMI160_ACCEL_Y_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_ACCEL_DATA_LENGTH);
- *v_accel_y_s16 = (s16)
- ((((s32)((s8)v_data_u8[BMI160_ACCEL_Y_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_data_u8[BMI160_ACCEL_Y_LSB_BYTE]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads Accel data Z values
- * from the register 0x16 and 0x17.
- *
- * @param v_accel_z_s16 : The value of Accel z axis.
- *
- * @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 to 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[BMI160_ACCEL_Z_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_ACCEL_DATA_LENGTH);
- *v_accel_z_s16 = (s16)
- ((((s32)((s8)a_data_u8r[BMI160_ACCEL_Z_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_ACCEL_Z_LSB_BYTE]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads Accel data X,Y,Z values
- * from the register 0x12 to 0x17.
- *
- * @param Accel :The value of Accel xyz axis.
- *
- * @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 to 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[BMI160_ACCEL_XYZ_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_ACCEL_XYZ_DATA_LENGTH);
- /* Data X */
- accel->x = (s16)
- ((((s32)((s8)a_data_u8r[
- BMI160_DATA_FRAME_ACCEL_X_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_ACCEL_X_LSB_BYTE]));
- /* Data Y */
- accel->y = (s16)
- ((((s32)((s8)a_data_u8r[
- BMI160_DATA_FRAME_ACCEL_Y_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_ACCEL_Y_LSB_BYTE]));
- /* Data Z */
- accel->z = (s16)
- ((((s32)((s8)a_data_u8r[
- BMI160_DATA_FRAME_ACCEL_Z_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_ACCEL_Z_LSB_BYTE]));
- }
- 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 to 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[BMI160_SENSOR_TIME_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_SENSOR_TIME_LENGTH);
- *v_sensor_time_u32 = (u32)
- ((((u32)a_data_u8r[BMI160_SENSOR_TIME_MSB_BYTE])
- << BMI160_SHIFT_BIT_POSITION_BY_16_BITS)
- |(((u32)a_data_u8r[BMI160_SENSOR_TIME_XLSB_BYTE])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_SENSOR_TIME_LSB_BYTE]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads sensor_time, Accel data, gyro data from the
- * register 0x0C to 0x1A.
- *
- * @param accel_gyro_sensortime_select : to select the configuration
- * value | output
- * ---------|----------------
- * 0 | Accel data and Sensor time
- * 1 | Accel data ,Gyro data and Sensor time
- *
- * @param accel_gyro_sensor_time : the value of Accel data, gyro data and
- * sensor time data
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_read_accel_gyro_sensor_time(
- u8 accel_gyro_sensortime_select,
- struct bmi160_sensortime_accel_gyro_data *accel_gyro_sensor_time)
- {
- u8 a_data_u8r[BMI160_GYRO_ACCEL_SENSORTIME_DATA_SIZE];
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- switch (accel_gyro_sensortime_select) {
- case BMI160_ACCEL_SENSORTIME_DATA:
- com_rslt = p_bmi160->BMI160_BURST_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_DATA_14_ACCEL_X_LSB__REG, a_data_u8r,
- BMI160_ACCEL_SENSORTIME_DATA_SIZE);
- /* Accel Data X */
- accel_gyro_sensor_time->accel.x = (s16)((((s32)
- ((s8)a_data_u8r[BMI160_DATA_FRAME_ACCEL_X_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_ACCEL_X_LSB_BYTE]));
- /* Accel Data Y */
- accel_gyro_sensor_time->accel.y = (s16)((((s32)
- ((s8)a_data_u8r[BMI160_DATA_FRAME_ACCEL_Y_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_ACCEL_Y_LSB_BYTE]));
- /* Accel Data Z */
- accel_gyro_sensor_time->accel.z = (s16)((((s32)
- ((s8)a_data_u8r[BMI160_DATA_FRAME_ACCEL_Z_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_ACCEL_Z_LSB_BYTE]));
- /* Sensor time data */
- accel_gyro_sensor_time->v_sensor_time_u32 = (u32)((
- ((u32)a_data_u8r[BMI160_DATA_FRAME_ACCEL_Z_MSB_BYTE+3])
- << BMI160_SHIFT_BIT_POSITION_BY_16_BITS)|
- (((u32)a_data_u8r[BMI160_DATA_FRAME_ACCEL_Z_MSB_BYTE+2])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_ACCEL_Z_MSB_BYTE+1]));
- break;
- case BMI160_GYRO_ACCEL_SENSORTIME_DATA:
- com_rslt = p_bmi160->BMI160_BURST_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_DATA_8_GYRO_X_LSB__REG, a_data_u8r,
- BMI160_GYRO_ACCEL_SENSORTIME_DATA_SIZE);
- /* Gyro Data X */
- accel_gyro_sensor_time->gyro.x = (s16)((((s32)((s8)
- a_data_u8r[BMI160_DATA_FRAME_GYRO_X_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_GYRO_X_LSB_BYTE]));
- /* Gyro Data Y */
- accel_gyro_sensor_time->gyro.y = (s16)((((s32)
- ((s8)a_data_u8r[BMI160_DATA_FRAME_GYRO_Y_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_GYRO_Y_LSB_BYTE]));
- /* Gyro Data Z */
- accel_gyro_sensor_time->gyro.z = (s16)((((s32)
- ((s8)a_data_u8r[BMI160_DATA_FRAME_GYRO_Z_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_GYRO_Z_LSB_BYTE]));
- /* Accel Data X */
- accel_gyro_sensor_time->accel.x = (s16)((((s32)
- ((s8)a_data_u8r[BMI160_DATA_FRAME_GYRO_Z_MSB_BYTE+2]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_GYRO_Z_MSB_BYTE+1]));
- /* Accel Data Y */
- accel_gyro_sensor_time->accel.y = (s16)((((s32)
- ((s8)a_data_u8r[BMI160_DATA_FRAME_GYRO_Z_MSB_BYTE+4]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_GYRO_Z_MSB_BYTE+3]));
- /* Accel Data Z */
- accel_gyro_sensor_time->accel.z = (s16)((((s32)
- ((s8)a_data_u8r[BMI160_DATA_FRAME_GYRO_Z_MSB_BYTE+6]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_GYRO_Z_MSB_BYTE+5]));
- /* Sensor time data */
- accel_gyro_sensor_time->v_sensor_time_u32 = (u32)
- ((((u32)a_data_u8r[BMI160_DATA_FRAME_GYRO_Z_MSB_BYTE+9])
- << BMI160_SHIFT_BIT_POSITION_BY_16_BITS)
- |(((u32)a_data_u8r[BMI160_DATA_FRAME_GYRO_Z_MSB_BYTE+8])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_DATA_FRAME_GYRO_Z_MSB_BYTE+7]));
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the Gyro self test
- * status from the register 0x1B bit 1
- *
- * @param v_gyro_selftest_u8 : The value of gyro self test status
- * value | status
- * ---------|----------------
- * 0 | Gyro self test is running or failed
- * 1 | Gyro 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 from the register 0x1B bit 2.
- *
- * @param v_mag_manual_stat_u8 : The value of Mag manual operation status
- * value | status
- * ---------|----------------
- * 0 | Indicates no manual Mag
- * - | interface operation is ongoing
- * 1 | Indicates manual Mag
- * - | 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_foc_rdy_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_STAT_FOC_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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 from the
- * register 0x1B bit 7
- * The status get reset when Accel data register is read
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_data_rdy_intr_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_1_DATA_RDY_INTR);
- }
- return com_rslt;
- }
- #ifdef FIFO_ENABLE
- /*!
- * @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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_fifo_wm_intr_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_STAT_1_FIFO_WM_INTR);
- }
- return com_rslt;
- }
- #endif
- /*!
- * @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 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 g sign status from the
- * register 0x1F bit 3
- *
- *
- *
- *
- * @param v_high_g_sign_u8 :The status of high g 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to 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[BMI160_TEMP_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_TEMP_DATA_LENGTH);
- *v_temp_s16 =
- (s16)(((s32)((s8) (v_data_u8[BMI160_TEMP_MSB_BYTE]) <<
- BMI160_SHIFT_BIT_POSITION_BY_08_BITS))
- | v_data_u8[BMI160_TEMP_LSB_BYTE]);
- }
- return com_rslt;
- }
- #ifdef FIFO_ENABLE
- /*!
- * @brief This API reads the FIFO length of the sensor
- * from the register 0x23 and 0x24 bit 0 to 7 and 0 to 2
- * @brief this byte counter is updated each time a complete frame
- * is read or written
- *
- *
- * @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 to 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[BMI160_FIFO_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_FIFO_DATA_LENGTH);
- a_data_u8r[BMI160_FIFO_LENGTH_MSB_BYTE] =
- BMI160_GET_BITSLICE(
- a_data_u8r[BMI160_FIFO_LENGTH_MSB_BYTE],
- BMI160_USER_FIFO_BYTE_COUNTER_MSB);
- *v_fifo_length_u32 =
- (u32)(((u32)((u8) (
- a_data_u8r[BMI160_FIFO_LENGTH_MSB_BYTE]) <<
- BMI160_SHIFT_BIT_POSITION_BY_08_BITS))
- | a_data_u8r[BMI160_FIFO_LENGTH_LSB_BYTE]);
- }
- 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_fifodata_u8 : Pointer holding the FIFO data
- * @param v_fifo_length_u16 : The value of FIFO length maximum 1024
- *
- * @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_fifodata_u8, u16 v_fifo_length_u16)
- {
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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_fifodata_u8, v_fifo_length_u16);
- }
- return com_rslt;
- }
- #endif
- /*!
- * @brief This API is used to get the
- * Accel output data rate from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 from 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
- *
- * @param v_accel_bw_u8 :The value of Accel selected Accel bandwidth
- * value | output data rate
- * -------|--------------------------
- * 0 | BMI160_ACCEL_OSR4_AVG1
- * 1 | BMI160_ACCEL_OSR2_AVG2
- * 2 | BMI160_ACCEL_NORMAL_AVG4
- * 3 | BMI160_ACCEL_CIC_AVG8
- * 4 | BMI160_ACCEL_RES_AVG2
- * 5 | BMI160_ACCEL_RES_AVG4
- * 6 | BMI160_ACCEL_RES_AVG8
- * 7 | BMI160_ACCEL_RES_AVG16
- * 8 | BMI160_ACCEL_RES_AVG32
- * 9 | BMI160_ACCEL_RES_AVG64
- * 10 | BMI160_ACCEL_RES_AVG128
- *
- *
- *
- *
- *
- * @note Verify the Accel bandwidth before setting the
- * output data rate
- * bandwidth | output data rate | under sampling
- *-------------|------------------|----------------
- * OSR4 | 12.5 TO 1600 | 0
- * OSR2 | 12.5 TO 1600 | 0
- * NORMAL | 12.5 TO 1600 | 0
- * CIC | 12.5 TO 1600 | 0
- * AVG2 | 0.78 TO 400 | 1
- * AVG4 | 0.78 TO 200 | 1
- * AVG8 | 0.78 TO 100 | 1
- * AVG16 | 0.78 TO 50 | 1
- * AVG32 | 0.78 TO 25 | 1
- * AVG64 | 0.78 TO 12.5 | 1
- * AVG128 | 0.78 TO 6.25 | 1
- *
- * @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, u8 v_accel_bw_u8)
- {
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 v_odr_u8 = BMI160_INIT_VALUE;
- u8 v_assign_bw = BMI160_ASSIGN_DATA;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if ((v_accel_bw_u8 >= BMI160_ACCEL_RES_AVG2) &&
- (v_accel_bw_u8 <= BMI160_ACCEL_RES_AVG128)) {
- /* enable the under sampling*/
- com_rslt = bmi160_set_accel_under_sampling_parameter(
- BMI160_US_ENABLE);
- } else if (((v_accel_bw_u8 > BMI160_ACCEL_OSR4_AVG1) &&
- (v_accel_bw_u8 <= BMI160_ACCEL_CIC_AVG8))
- || (v_accel_bw_u8 == BMI160_ACCEL_OSR4_AVG1)) {
- /* disable the under sampling*/
- com_rslt = bmi160_set_accel_under_sampling_parameter(
- BMI160_US_DISABLE);
- }
- /* assign the output data rate*/
- switch (v_accel_bw_u8) {
- case BMI160_ACCEL_RES_AVG2:
- if (v_output_data_rate_u8
- >= BMI160_ACCEL_OUTPUT_DATA_RATE_0_78HZ
- && v_output_data_rate_u8
- <= BMI160_ACCEL_OUTPUT_DATA_RATE_400HZ) {
- v_odr_u8 = v_output_data_rate_u8;
- v_assign_bw = SUCCESS;
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- break;
- case BMI160_ACCEL_RES_AVG4:
- if (v_output_data_rate_u8
- >= BMI160_ACCEL_OUTPUT_DATA_RATE_0_78HZ
- && v_output_data_rate_u8
- <= BMI160_ACCEL_OUTPUT_DATA_RATE_200HZ) {
- v_odr_u8 = v_output_data_rate_u8;
- v_assign_bw = SUCCESS;
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- break;
- case BMI160_ACCEL_RES_AVG8:
- if (v_output_data_rate_u8
- >= BMI160_ACCEL_OUTPUT_DATA_RATE_0_78HZ
- && v_output_data_rate_u8
- <= BMI160_ACCEL_OUTPUT_DATA_RATE_100HZ) {
- v_odr_u8 = v_output_data_rate_u8;
- v_assign_bw = SUCCESS;
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- break;
- case BMI160_ACCEL_RES_AVG16:
- if (v_output_data_rate_u8
- >= BMI160_ACCEL_OUTPUT_DATA_RATE_0_78HZ
- && v_output_data_rate_u8
- <= BMI160_ACCEL_OUTPUT_DATA_RATE_50HZ) {
- v_odr_u8 = v_output_data_rate_u8;
- v_assign_bw = SUCCESS;
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- break;
- case BMI160_ACCEL_RES_AVG32:
- if (v_output_data_rate_u8
- >= BMI160_ACCEL_OUTPUT_DATA_RATE_0_78HZ
- && v_output_data_rate_u8
- <= BMI160_ACCEL_OUTPUT_DATA_RATE_25HZ) {
- v_odr_u8 = v_output_data_rate_u8;
- v_assign_bw = SUCCESS;
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- break;
- case BMI160_ACCEL_RES_AVG64:
- if (v_output_data_rate_u8
- >= BMI160_ACCEL_OUTPUT_DATA_RATE_0_78HZ
- && v_output_data_rate_u8
- <= BMI160_ACCEL_OUTPUT_DATA_RATE_12_5HZ) {
- v_odr_u8 = v_output_data_rate_u8;
- v_assign_bw = SUCCESS;
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- break;
- case BMI160_ACCEL_RES_AVG128:
- if (v_output_data_rate_u8
- >= BMI160_ACCEL_OUTPUT_DATA_RATE_0_78HZ
- && v_output_data_rate_u8
- <= BMI160_ACCEL_OUTPUT_DATA_RATE_6_25HZ) {
- v_odr_u8 = v_output_data_rate_u8;
- v_assign_bw = SUCCESS;
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- break;
- case BMI160_ACCEL_OSR4_AVG1:
- if ((v_output_data_rate_u8
- >= BMI160_ACCEL_OUTPUT_DATA_RATE_12_5HZ)
- && (v_output_data_rate_u8
- <= BMI160_ACCEL_OUTPUT_DATA_RATE_1600HZ)) {
- v_odr_u8 = v_output_data_rate_u8;
- v_assign_bw = SUCCESS;
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- break;
- case BMI160_ACCEL_OSR2_AVG2:
- if ((v_output_data_rate_u8
- >= BMI160_ACCEL_OUTPUT_DATA_RATE_12_5HZ)
- && (v_output_data_rate_u8
- <= BMI160_ACCEL_OUTPUT_DATA_RATE_1600HZ)) {
- v_odr_u8 = v_output_data_rate_u8;
- v_assign_bw = SUCCESS;
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- break;
- case BMI160_ACCEL_NORMAL_AVG4:
- if ((v_output_data_rate_u8
- >= BMI160_ACCEL_OUTPUT_DATA_RATE_12_5HZ)
- && (v_output_data_rate_u8
- <= BMI160_ACCEL_OUTPUT_DATA_RATE_1600HZ)) {
- v_odr_u8 = v_output_data_rate_u8;
- v_assign_bw = SUCCESS;
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- break;
- case BMI160_ACCEL_CIC_AVG8:
- if ((v_output_data_rate_u8
- >= BMI160_ACCEL_OUTPUT_DATA_RATE_12_5HZ)
- && (v_output_data_rate_u8
- <= BMI160_ACCEL_OUTPUT_DATA_RATE_1600HZ)) {
- v_odr_u8 = v_output_data_rate_u8;
- v_assign_bw = SUCCESS;
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- if (v_assign_bw == SUCCESS) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_CONFIG_OUTPUT_DATA_RATE,
- v_odr_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_ACCEL_CONFIG_OUTPUT_DATA_RATE__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* select Accel bandwidth*/
- if (v_bw_u8 <= BMI160_MAX_ACCEL_BW) {
- /* 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the Accel
- * under sampling parameter from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_accel_under_sampling_u8 <= BMI160_MAX_UNDER_SAMPLING) {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_ACCEL_CONFIG_ACCEL_UNDER_SAMPLING__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the range
- * (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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_range_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_ACCEL_RANGE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set the range
- * (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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if ((v_range_u8 == BMI160_ACCEL_RANGE0) ||
- (v_range_u8 == BMI160_ACCEL_RANGE1) ||
- (v_range_u8 == BMI160_ACCEL_RANGE3) ||
- (v_range_u8 == BMI160_ACCEL_RANGE4)) {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_ACCEL_RANGE__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the
- * Gyro 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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
- * Gyro 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* select the gyro output data rate*/
- if ((v_output_data_rate_u8 < BMI160_OUTPUT_DATA_RATE6) &&
- (v_output_data_rate_u8 != BMI160_INIT_VALUE)
- && (v_output_data_rate_u8 != BMI160_OUTPUT_DATA_RATE1)
- && (v_output_data_rate_u8 != BMI160_OUTPUT_DATA_RATE2)
- && (v_output_data_rate_u8 != BMI160_OUTPUT_DATA_RATE3)
- && (v_output_data_rate_u8 != BMI160_OUTPUT_DATA_RATE4)
- && (v_output_data_rate_u8 != BMI160_OUTPUT_DATA_RATE5)
- && (v_output_data_rate_u8 != BMI160_OUTPUT_DATA_RATE6)
- && (v_output_data_rate_u8 != BMI160_OUTPUT_DATA_RATE7)) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the
- * bandwidth 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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
- * bandwidth 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_bw_u8 <= BMI160_MAX_GYRO_BW) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_range_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_RANGE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API sets 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_range_u8 <= BMI160_MAX_GYRO_RANGE) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the
- * output data rate of Mag from the register 0x44 bit 0 to 3
- *
- *
- *
- *
- * @param v_output_data_rate_u8 : 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_rate_u8)
- {
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_output_data_rate_u8 = 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 Mag from the register 0x44 bit 0 to 3
- *
- *
- *
- *
- * @param v_output_data_rate_u8 : 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_rate_u8)
- {
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* select the Mag data output rate*/
- if ((v_output_data_rate_u8
- <= BMI160_MAX_ACCEL_OUTPUT_DATA_RATE)
- && (v_output_data_rate_u8
- != BMI160_OUTPUT_DATA_RATE0)
- && (v_output_data_rate_u8
- != BMI160_OUTPUT_DATA_RATE6)
- && (v_output_data_rate_u8
- != BMI160_OUTPUT_DATA_RATE7)) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- if (com_rslt == SUCCESS) {
- v_data_u8 = BMI160_SET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_CONFIG_OUTPUT_DATA_RATE,
- v_output_data_rate_u8);
- com_rslt +=
- p_bmi160->BMI160_BUS_WRITE_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_MAG_CONFIG_OUTPUT_DATA_RATE__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- #ifdef FIFO_ENABLE
- /*!
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- }
- 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_gyro_fifo_filter_data_u8
- <= BMI160_MAX_VALUE_FIFO_FILTER) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- } 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read Accel FIFO filter data
- * from the register 0x45 bit 7
- *
- *
- *
- * @param accel_fifo_filter_u8 :The value of Accel filter data
- * value | accel_fifo_filter_u8
- * ------------|-------------------------
- * 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 *accel_fifo_filter_u8)
- {
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_accel_fifo_filter_u8 <= BMI160_MAX_VALUE_FIFO_FILTER) {
- com_rslt =
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_FIFO_FILTER_ACCEL__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- } 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads FIFO sensor time
- * frame after the last valid data frame from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_fifo_time_enable_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_TIME_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API sets FIFO sensor time
- * frame after the last valid data frame from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_time_enable_u8 <= BMI160_MAX_VALUE_FIFO_TIME) {
- /* 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads FIFO tag interrupt2 enable status
- * from the register 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_fifo_tag_intr2_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_TAG_INTR2_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API sets FIFO tag interrupt2 enable status
- * from the register 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_tag_intr2_u8 <= BMI160_MAX_VALUE_FIFO_INTR) {
- /* 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads FIFO tag interrupt1 enable status
- * from the register 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_fifo_tag_intr1_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_TAG_INTR1_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API sets FIFO tag interrupt1 enable status
- * from the register 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_tag_intr1_u8 <= BMI160_MAX_VALUE_FIFO_INTR) {
- /* write the FIFO tag interrupt*/
- com_rslt = bmi160_set_input_enable(BMI160_INIT_VALUE,
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_fifo_header_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_HEADER_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API sets 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_header_u8 <= BMI160_MAX_VALUE_FIFO_HEADER) {
- /* 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to check whether
- * Mag data in FIFO (all 3 axes) or not from the
- * register 0x47 bit 5
- *
- * @param v_fifo_mag_u8 : The value of FIFO Mag enable
- * value | FIFO mag
- * ----------|-------------------
- * 0x00 | no Mag data is stored
- * 0x01 | Mag 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_fifo_mag_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_MAG_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to enable
- * Mag data in FIFO (all 3 axes) from the register 0x47 bit 5
- *
- * @param v_fifo_mag_u8 : The value of FIFO Mag enable
- * value | FIFO mag
- * ----------|-------------------
- * 0x00 | no Mag data is stored
- * 0x01 | Mag 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_mag_u8 <= BMI160_MAX_VALUE_FIFO_MAG) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to check whether
- * Accel data is stored in FIFO (all 3 axes) or not from the
- * register 0x47 bit 6
- *
- * @param v_fifo_accel_u8 : The value of FIFO Accel enable
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_fifo_accel_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_ACCEL_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to enable
- * Accel data in FIFO (all 3 axes) from the register 0x47 bit 6
- *
- * @param v_fifo_accel_u8 : The value of FIFO Accel enable
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_accel_u8 <= BMI160_MAX_VALUE_FIFO_ACCEL) {
- /* 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to check whether
- * gyro data is stored in FIFO (all 3 axes) or not from the
- * register 0x47 bit 7
- *
- *
- * @param v_fifo_gyro_u8 : The value of FIFO gyro enable
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_fifo_gyro_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FIFO_GYRO_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to enable
- * gyro data in FIFO (all 3 axes) from the register 0x47 bit 7
- *
- *
- * @param v_fifo_gyro_u8 : The value of FIFO gyro enable
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_fifo_gyro_u8 <= BMI160_MAX_VALUE_FIFO_GYRO) {
- /* 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- #endif
- /*!
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read the
- * 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 length
- *
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 length
- *
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_mag_offset_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_MAG_OFFSET);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set the
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read the
- * Enable register access on MAG_IF[2] or MAG_IF[3].
- * This implies that the DATA registers are not updated with
- * Mag values. Accessing Mag requires
- * the Mag 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 the
- * Enable register access of MAG_IF[2] or MAG_IF[3].
- * This implies that the DATA registers are not updated with
- * Mag values. Accessing Mag requires
- * the Mag 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = BMI160_INIT_VALUE;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- if (com_rslt == SUCCESS)
- p_bmi160->mag_manual_enable = v_mag_manual_u8;
- else
- p_bmi160->mag_manual_enable = E_BMI160_COMM_RES;
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the
- * Mag read address from the register 0x4D bit 0 to 7
- * @brief 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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
- * Mag read address from the register 0x4D bit 0 to 7
- * @brief address where data will be read from auxiliary mag
- *
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read
- * Mag write address from the register 0x4E bit 0 to 7
- * @brief write address where data will be written in Mag
- *
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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
- * Mag write address from the register 0x4E bit 0 to 7
- * @brief this is the address in Mag where the data will be written
- *
- *
- *
- * @param v_mag_write_addr_u8:
- * The address which the data will be written to
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to read Mag write data
- * from the register 0x4F bit 0 to 7
- * @brief The data will be written 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 Mag write data
- * from the register 0x4F bit 0 to 7
- * @brief The data will be written 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 which selects the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 which selects the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 which selects 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 select the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API configures 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the configure level condition of
- * interrupt1 and interrupt2 pin from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API is used to set the configure level condition of
- * interrupt1 and interrupt2 pin from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API is 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the output enable for interrupt1
- * and interrupt2 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_ENABLE
- * 1 | BMI160_INTR2_OUTPUT_ENABLE
- *
- * @param v_output_enable_u8 :
- * The value of output enable of interrupt enable
- * value | Behaviour
- * ----------|-------------------
- * 0x01 | INTERRUPT OUTPUT ENABLED
- * 0x00 | INTERRUPT OUTPUT DISABLED
- *
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API is used to set the Output enable for interrupt1
- * and interrupt2 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_ENABLE
- * 1 | BMI160_INTR2_OUTPUT_ENABLE
- *
- * @param v_output_enable_u8 :
- * The value of output enable of interrupt enable
- * value | Behaviour
- * ----------|-------------------
- * 0x01 | INTERRUPT OUTPUT ENABLED
- * 0x00 | INTERRUPT OUTPUT DISABLED
- *
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 = BMI160_INIT_VALUE;
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_latch_intr_u8 <= BMI160_MAX_LATCH_INTR) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief API is 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_ENABLED
- * 0x00 | BMI160_INPUT_DISABLED
- *
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- switch (v_channel_u8) {
- /* read input enable of interrupt1 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 is 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_ENABLED
- * 0x00 | BMI160_INPUT_DISABLED
- *
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the Low g interrupt which is 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API sets the Low g interrupt to be 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 v_step_cnt_stat_u8 = BMI160_INIT_VALUE;
- u8 v_step_det_stat_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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 != BMI160_INIT_VALUE)
- com_rslt += bmi160_set_step_detector_enable(BMI160_INIT_VALUE);
- /* 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 != BMI160_INIT_VALUE)
- com_rslt += bmi160_set_step_counter_enable(
- BMI160_INIT_VALUE);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the HIGH g interrupt which is 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API writes the HIGH g interrupt to be 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the Any motion interrupt which is 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API writes the Any motion interrupt
- * to be 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 sig_mot_stat = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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 != BMI160_INIT_VALUE)
- com_rslt += bmi160_set_intr_significant_motion_select(
- BMI160_INIT_VALUE);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the No motion interrupt
- * which is 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API configures the No motion interrupt
- * to be 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the Double Tap interrupt
- * which is 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API configures the Double Tap interrupt
- * to be 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the Single Tap interrupt
- * which is 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API configures the Single Tap interrupt
- * to be 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the Orient interrupt which is 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API configures the Orient interrupt
- * to be 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the Flat interrupt which is
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API configures the Flat interrupt to be
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the PMU trigger interrupt which is mapped to
- * interrupt1 and interrupt2 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API configures the PMU trigger interrupt to be mapped to
- * interrupt1 and interrupt2 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- #ifdef FIFO_ENABLE
- /*!
- * @brief This API reads the FIFO Full interrupt which is mapped to
- * interrupt1 and interrupt2 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API configures the FIFO Full interrupt to be mapped to
- * interrupt1 and interrupt2 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads FIFO Watermark interrupt which is mapped to
- * interrupt1 and interrupt2 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API configures FIFO Watermark interrupt to be mapped to
- * interrupt1 and interrupt2 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- }
- return com_rslt;
- }
- #endif
- /*!
- * @brief This API reads Data Ready interrupt which is mapped to interrupt1
- * and interrupt2 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 This API configures Data Ready interrupt to be mapped to
- * interrupt1 and interrupt2 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /*Accel and Gyro power mode check */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_tap_source_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_DATA_0_INTR_TAP_SOURCE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_tap_source_u8 <= BMI160_MAX_VALUE_SOURCE_INTR) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } 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 low-g/high-g 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 writes 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 low-g/high-g 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_low_high_source_u8 <= BMI160_MAX_VALUE_SOURCE_INTR) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_motion_source_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_DATA_1_INTR_MOTION_SOURCE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_motion_source_u8 <= BMI160_MAX_VALUE_SOURCE_INTR) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 from 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 writes 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 writes 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_low_g_mode_u8 <= BMI160_MAX_VALUE_LOW_G_MODE) {
- /*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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } 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 "bmi160_set_accel_range"
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 writes 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 "bmi160_set_accel_range"
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 "bmi160_set_accel_range"
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 "bmi160_set_accel_range"
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 writes 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 writes 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- 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 "bmi160_set_accel_range"
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 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 "bmi160_set_accel_range"
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 "bmi160_set_accel_range"
- * 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 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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
- * in 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 "bmi160_set_accel_range"
- * 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 for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- 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 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_intr_slow_no_motion_select_u8 <= BMI160_MAX_VALUE_NO_MOTION) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel and
- gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- } 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_intr_significant_motion_select_u8 <=
- BMI160_MAX_VALUE_SIGNIFICANT_MOTION) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to unmap the signification motion
- * interrupt
- *
- *
- * @param v_significant_u8 : The value of interrupt selection
- *
- * BMI160_MAP_INTR1 0
- * BMI160_MAP_INTR2 1
- *
- * \return results of communication routine
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_unmap_significant_motion_intr(
- u8 v_significant_u8)
- {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_any_motion_intr1_stat_u8 = V_ANY_MOTION_INTR_STAT;
- u8 v_any_motion_intr2_stat_u8 = V_ANY_MOTION_INTR_STAT;
- u8 v_any_motion_axis_stat_u8 = V_ANY_MOTION_AXIS_STAT;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- switch (v_significant_u8) {
- case BMI160_MAP_INTR1:
- /* interrupt */
- com_rslt = bmi160_read_reg(
- BMI160_USER_INTR_MAP_0_INTR1_ANY_MOTION__REG,
- &v_data_u8, BMI160_ASSIGN_DATA);
- v_data_u8 &= ~(v_any_motion_intr1_stat_u8);
- /* map the signification interrupt
- to any-motion interrupt1*/
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_MAP_0_INTR1_ANY_MOTION__REG,
- &v_data_u8, BMI160_ASSIGN_DATA);
- p_bmi160->delay_msec(BMI160_ASSIGN_DATA);
- /* axis*/
- com_rslt = bmi160_read_reg(
- BMI160_USER_INTR_ENABLE_0_ADDR,
- &v_data_u8, BMI160_ASSIGN_DATA);
- v_data_u8 &= ~(v_any_motion_axis_stat_u8);
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_ENABLE_0_ADDR,
- &v_data_u8, BMI160_ASSIGN_DATA);
- p_bmi160->delay_msec(BMI160_ASSIGN_DATA);
- break;
- case BMI160_MAP_INTR2:
- /* map the signification interrupt
- to any-motion interrupt2*/
- com_rslt = bmi160_read_reg(
- BMI160_USER_INTR_MAP_2_INTR2_ANY_MOTION__REG,
- &v_data_u8, BMI160_ASSIGN_DATA);
- v_data_u8 &= ~(v_any_motion_intr2_stat_u8);
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_MAP_2_INTR2_ANY_MOTION__REG,
- &v_data_u8, BMI160_ASSIGN_DATA);
- p_bmi160->delay_msec(BMI160_ASSIGN_DATA);
- /* axis*/
- com_rslt = bmi160_read_reg(BMI160_USER_INTR_ENABLE_0_ADDR,
- &v_data_u8, BMI160_ASSIGN_DATA);
- v_data_u8 &= ~(v_any_motion_axis_stat_u8);
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_ENABLE_0_ADDR,
- &v_data_u8, BMI160_ASSIGN_DATA);
- p_bmi160->delay_msec(BMI160_ASSIGN_DATA);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- 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 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_int_sig_mot_skip_u8 <= BMI160_MAX_UNDER_SIG_MOTION) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_significant_motion_proof_u8
- <= BMI160_MAX_UNDER_SIG_MOTION) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } 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
- * 0x02 | BMI160_TAP_DURN_150MS
- * 0x03 | BMI160_TAP_DURN_200MS
- * 0x04 | BMI160_TAP_DURN_250MS
- * 0x05 | BMI160_TAP_DURN_375MS
- * 0x06 | BMI160_TAP_DURN_500MS
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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
- * in 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
- * 0x02 | BMI160_TAP_DURN_150MS
- * 0x03 | BMI160_TAP_DURN_200MS
- * 0x04 | BMI160_TAP_DURN_250MS
- * 0x05 | BMI160_TAP_DURN_375MS
- * 0x06 | BMI160_TAP_DURN_500MS
- * 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 = BMI160_INIT_VALUE;
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_tap_durn_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_tap_durn_u8 <= BMI160_MAX_TAP_TURN) {
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_tap_shock_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_TAP_0_INTR_TAP_SHOCK);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_tap_shock_u8 <= BMI160_MAX_VALUE_TAP_SHOCK) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_tap_quiet_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_INTR_TAP_0_INTR_TAP_QUIET);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes
- * tap quiet duration in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_tap_quiet_u8 <= BMI160_MAX_VALUE_TAP_QUIET) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the 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 "bmi160_set_accel_range"
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_tap_thres_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_TAP_1_INTR_TAP_THRES);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the threshold of the
- * single/double tap interrupt in 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 "bmi160_set_accel_range"
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_orient_mode_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_MODE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_orient_mode_u8 <= BMI160_MAX_ORIENT_MODE) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the orientation 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_orient_blocking_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_BLOCKING);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the orientation blocking mode
- * that is used for the generation of the orientation interrupt.
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_orient_blocking_u8 <= BMI160_MAX_ORIENT_BLOCKING) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the orientation 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_orient_hyst_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_ORIENT_0_INTR_ORIENT_HYST);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the orientation interrupt
- * hysteresis, in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the orientation
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_orient_theta_u8 = BMI160_GET_BITSLICE
- (v_data_u8,
- BMI160_USER_INTR_ORIENT_1_INTR_ORIENT_THETA);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes orientation
- * blocking angle (0 to 44.8) in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_orient_theta_u8 <= BMI160_MAX_ORIENT_THETA) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the orientation 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 writes orientation change
- * of up/down bit in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_orient_ud_u8 <= BMI160_MAX_VALUE_ORIENT_UD) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *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 writes orientation axes changes
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_orient_axes_u8 <= BMI160_MAX_VALUE_ORIENT_AXES) {
- /*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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_flat_theta_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_FLAT_0_INTR_FLAT_THETA);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes Flat angle (0 to 44.8) for flat interrupt
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_flat_theta_u8 <= BMI160_MAX_FLAT_THETA) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_flat_hold_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_INTR_FLAT_1_INTR_FLAT_HOLD);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes flat interrupt hold time in
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_flat_hold_u8 <= BMI160_MAX_FLAT_HOLD) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_flat_hyst_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_INTR_FLAT_1_INTR_FLAT_HYST);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes flat interrupt hysteresis
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_flat_hyst_u8 <= BMI160_MAX_FLAT_HYST) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_foc_accel_z_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_ACCEL_Z);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes Accel offset compensation
- * target value for z-axis in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_foc_accel_y_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_ACCEL_Y);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes Accel offset compensation
- * target value for y-axis in 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
- * 0x02 | -1g
- * 0x03 | 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_foc_accel_y_u8 <= BMI160_MAX_ACCEL_FOC) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads Accel offset compensation
- * target value for x-axis 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
- * 0x02 | -1g
- * 0x03 | 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_foc_accel_x_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_ACCEL_X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes Accel offset compensation
- * target value for x-axis in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_foc_accel_x_u8 <= BMI160_MAX_ACCEL_FOC) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- } 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- s8 v_status_s8 = SUCCESS;
- u8 v_timeout_u8 = BMI160_INIT_VALUE;
- s8 v_foc_accel_offset_x_s8 = BMI160_INIT_VALUE;
- s8 v_foc_accel_offset_y_s8 = BMI160_INIT_VALUE;
- s8 v_foc_accel_offset_z_s8 = BMI160_INIT_VALUE;
- u8 focstatus = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- /* trigger the FOC */
- com_rslt +=
- bmi160_set_command_register(
- START_FOC_ACCEL_GYRO);
- com_rslt +=
- bmi160_get_foc_rdy(&focstatus);
- if ((com_rslt != SUCCESS) ||
- (focstatus != BMI160_FOC_STAT_HIGH)) {
- while ((com_rslt != SUCCESS) ||
- (focstatus != BMI160_FOC_STAT_HIGH
- && 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 == BMI160_FOC_STAT_HIGH)) {
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- /* trigger the FOC */
- com_rslt +=
- bmi160_set_command_register(
- START_FOC_ACCEL_GYRO);
- com_rslt +=
- bmi160_get_foc_rdy(&focstatus);
- if ((com_rslt != SUCCESS) ||
- (focstatus != BMI160_FOC_STAT_HIGH)) {
- while ((com_rslt != SUCCESS) ||
- (focstatus != BMI160_FOC_STAT_HIGH
- && 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 == BMI160_FOC_STAT_HIGH)) {
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- /* trigger the FOC */
- com_rslt +=
- bmi160_set_command_register(
- START_FOC_ACCEL_GYRO);
- com_rslt +=
- bmi160_get_foc_rdy(&focstatus);
- if ((com_rslt != SUCCESS) ||
- (focstatus != BMI160_FOC_STAT_HIGH)) {
- while ((com_rslt != SUCCESS) ||
- (focstatus != BMI160_FOC_STAT_HIGH
- && 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 == BMI160_FOC_STAT_HIGH)) {
- 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 writes fast Accel offset compensation
- * for all axis in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 focx = BMI160_INIT_VALUE;
- u8 focy = BMI160_INIT_VALUE;
- u8 focz = BMI160_INIT_VALUE;
- s8 v_foc_accel_offset_x_s8 = BMI160_INIT_VALUE;
- s8 v_foc_accel_offset_y_s8 = BMI160_INIT_VALUE;
- s8 v_foc_accel_offset_z_s8 = BMI160_INIT_VALUE;
- u8 v_status_s8 = SUCCESS;
- u8 v_timeout_u8 = BMI160_INIT_VALUE;
- u8 focstatus = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- /* foc y axis*/
- com_rslt +=
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Y__REG,
- &focy, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- /* foc z axis*/
- com_rslt +=
- p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_FOC_ACCEL_Z__REG,
- &focz, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- /* trigger the FOC */
- com_rslt += bmi160_set_command_register(
- START_FOC_ACCEL_GYRO);
- com_rslt += bmi160_get_foc_rdy(
- &focstatus);
- if ((com_rslt != SUCCESS) ||
- (focstatus != BMI160_FOC_STAT_HIGH)) {
- while ((com_rslt != SUCCESS) ||
- (focstatus != BMI160_FOC_STAT_HIGH
- && 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 == BMI160_GEN_READ_WRITE_DATA_LENGTH)) {
- 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 reads the 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 to return the status of bus communication */
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_foc_gyro_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_FOC_GYRO_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 v_status_s8 = SUCCESS;
- u8 v_timeout_u8 = BMI160_INIT_VALUE;
- s16 offsetx = BMI160_INIT_VALUE;
- s16 offsety = BMI160_INIT_VALUE;
- s16 offsetz = BMI160_INIT_VALUE;
- u8 focstatus = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- }
- /* trigger the FOC */
- com_rslt += bmi160_set_command_register
- (START_FOC_ACCEL_GYRO);
- com_rslt += bmi160_get_foc_rdy(&focstatus);
- if ((com_rslt != SUCCESS) ||
- (focstatus != BMI160_FOC_STAT_HIGH)) {
- while ((com_rslt != SUCCESS) ||
- (focstatus != BMI160_FOC_STAT_HIGH
- && 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 == BMI160_FOC_STAT_HIGH)) {
- 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 reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_spi3_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_IF_CONFIG_SPI3);
- }
- return com_rslt;
- }
- /*!
- * @brief This API configures SPI
- * Interface Mode for primary and OIS interface
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_spi3_u8 <= BMI160_MAX_VALUE_SPI3) {
- /* write SPI mode*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_SPI3__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_i2c_wdt_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_IF_CONFIG_I2C_WDT_SELECT);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the I2C Watchdog timer
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_i2c_wdt_u8 <= BMI160_MAX_VALUE_I2C_WDT) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the status of 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- /* read i2c watch dog enable */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_I2C_WDT_ENABLE__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_i2c_wdt_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_IF_CONFIG_I2C_WDT_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API enables the I2C watchdog
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_i2c_wdt_u8 <= BMI160_MAX_VALUE_I2C_WDT) {
- /* write i2c watch dog enable */
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_IF_CONFIG_I2C_WDT_ENABLE__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the I2C interface configuration(if) mode
- * 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:Mag
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_if_mode_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_IF_CONFIG_IF_MODE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the I2C interface configuration(if) mode
- * in 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:Mag
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_if_mode_u8 <= BMI160_MAX_IF_MODE) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_gyro_sleep_trigger_u8 =
- BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_GYRO_SLEEP_TRIGGER);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the gyro sleep trigger
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_gyro_sleep_trigger_u8 <= BMI160_MAX_GYRO_SLEEP_TRIGGER) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_gyro_wakeup_trigger_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_GYRO_WAKEUP_TRIGGER);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes gyro wakeup trigger
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_gyro_wakeup_trigger_u8
- <= BMI160_MAX_GYRO_WAKEUP_TRIGGER) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_gyro_sleep_state_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_GYRO_SLEEP_STATE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes target state for gyro sleep mode
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_gyro_sleep_state_u8 <= BMI160_MAX_VALUE_SLEEP_STATE) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads gyro wakeup interrupt
- * from the register 0x6C bit 6
- *
- * @param v_gyro_wakeup_intr_u8 : The value 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_gyro_wakeup_intr_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_GYRO_WAKEUP_INTR);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes gyro wakeup interrupt
- * in the register 0x6C bit 6
- *
- * @param v_gyro_wakeup_intr_u8 : The value 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_gyro_wakeup_intr_u8 <= BMI160_MAX_VALUE_WAKEUP_INTR) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads Accel selftest axis selected for self-test
- * functionality.
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_accel_selftest_axis_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_ACCEL_SELFTEST_AXIS);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes Accel self test axis for self-test
- * functionality.
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_accel_selftest_axis_u8
- <= BMI160_MAX_ACCEL_SELFTEST_AXIS) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_accel_selftest_sign_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_ACCEL_SELFTEST_SIGN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes Accel self test axis sign
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_accel_selftest_sign_u8 <=
- BMI160_MAX_VALUE_SELFTEST_SIGN) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads Accel self test amplitude
- * from the register 0x6D bit 3
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_accel_selftest_amp_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_SELFTEST_AMP);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes Accel self test amplitude
- * in the register 0x6D bit 3
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_accel_selftest_amp_u8 <=
- BMI160_MAX_VALUE_SELFTEST_AMP) {
- /* write self test amplitude*/
- com_rslt = p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_SELFTEST_AMP__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_gyro_selftest_start_u8 = BMI160_GET_BITSLICE(
- v_data_u8,
- BMI160_USER_GYRO_SELFTEST_START);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_gyro_selftest_start_u8 <=
- BMI160_MAX_VALUE_SELFTEST_START) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the 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 DISABLE
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_spi_enable_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_NV_CONFIG_SPI_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes primary interface selection I2C or SPI
- * in the register 0x70 bit 0
- *
- * @param v_spi_enable_u8: The value of Interface selection
- * Value | Description
- * --------|-------------
- * 0x00 | I2C Enable
- * 0x01 | I2C DISABLE
- *
- *
- * @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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_accel_off_x_s8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_0_ACCEL_OFF_X);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the Accel manual offset compensation of x axis
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 v_status_s8 = SUCCESS;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_accel_off_y_s8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_1_ACCEL_OFF_Y);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the Accel manual offset compensation of y axis
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 v_status_s8 = SUCCESS;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_accel_off_z_s8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_2_ACCEL_OFF_Z);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the Accel manual offset compensation of z axis
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 v_status_s8 = SUCCESS;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Check for the power mode of Accel
- and gyro not in normal mode */
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r = BMI160_INIT_VALUE;
- u8 v_data2_u8r = BMI160_INIT_VALUE;
- s16 v_data3_u8r, v_data4_u8r = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- v_data2_u8r = BMI160_GET_BITSLICE(v_data2_u8r,
- BMI160_USER_OFFSET_6_GYRO_OFF_X);
- v_data3_u8r = v_data2_u8r
- << BMI160_SHIFT_BIT_POSITION_BY_14_BITS;
- v_data4_u8r = v_data1_u8r
- << BMI160_SHIFT_BIT_POSITION_BY_06_BITS;
- v_data3_u8r = v_data3_u8r | v_data4_u8r;
- *v_gyro_off_x_s16 = v_data3_u8r
- >> BMI160_SHIFT_BIT_POSITION_BY_06_BITS;
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the gyro manual offset compensation of x axis
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r, v_data2_u8r = BMI160_INIT_VALUE;
- u16 v_data3_u8r = BMI160_INIT_VALUE;
- u8 v_status_s8 = SUCCESS;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- com_rslt += p_bmi160->BMI160_BUS_READ_FUNC(
- p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_X__REG,
- &v_data2_u8r, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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_BIT_POSITION_BY_08_BITS);
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- return ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r = BMI160_INIT_VALUE;
- u8 v_data2_u8r = BMI160_INIT_VALUE;
- s16 v_data3_u8r, v_data4_u8r = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- v_data2_u8r = BMI160_GET_BITSLICE(v_data2_u8r,
- BMI160_USER_OFFSET_6_GYRO_OFF_Y);
- v_data3_u8r = v_data2_u8r
- << BMI160_SHIFT_BIT_POSITION_BY_14_BITS;
- v_data4_u8r = v_data1_u8r
- << BMI160_SHIFT_BIT_POSITION_BY_06_BITS;
- v_data3_u8r = v_data3_u8r | v_data4_u8r;
- *v_gyro_off_y_s16 = v_data3_u8r
- >> BMI160_SHIFT_BIT_POSITION_BY_06_BITS;
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes gyro manual offset compensation of y axis
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r, v_data2_u8r = BMI160_INIT_VALUE;
- u16 v_data3_u8r = BMI160_INIT_VALUE;
- u8 v_status_s8 = SUCCESS;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- com_rslt += p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_Y__REG,
- &v_data2_u8r, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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_BIT_POSITION_BY_08_BITS);
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- return ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads the 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r = BMI160_INIT_VALUE;
- u8 v_data2_u8r = BMI160_INIT_VALUE;
- s16 v_data3_u8r, v_data4_u8r = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- v_data2_u8r = BMI160_GET_BITSLICE(
- v_data2_u8r,
- BMI160_USER_OFFSET_6_GYRO_OFF_Z);
- v_data3_u8r = v_data2_u8r
- << BMI160_SHIFT_BIT_POSITION_BY_14_BITS;
- v_data4_u8r = v_data1_u8r
- << BMI160_SHIFT_BIT_POSITION_BY_06_BITS;
- v_data3_u8r = v_data3_u8r | v_data4_u8r;
- *v_gyro_off_z_s16 = v_data3_u8r
- >> BMI160_SHIFT_BIT_POSITION_BY_06_BITS;
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes gyro manual offset compensation of z axis
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r, v_data2_u8r = BMI160_INIT_VALUE;
- u16 v_data3_u8r = BMI160_INIT_VALUE;
- u8 v_status_s8 = SUCCESS;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- com_rslt += p_bmi160->BMI160_BUS_READ_FUNC
- (p_bmi160->dev_addr,
- BMI160_USER_OFFSET_6_GYRO_OFF_Z__REG,
- &v_data2_u8r, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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_BIT_POSITION_BY_08_BITS);
- 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,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- return ERROR;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_accel_off_enable_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_6_ACCEL_OFF_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the Accel offset enable bit
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_gyro_off_enable_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_OFFSET_6_GYRO_OFF_EN);
- }
- return com_rslt;
- }
- /*!
- * @brief This API writes the gyro offset enable bit
- * in 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads step counter output value
- * from the register 0x78 and 0x79
- *
- *
- *
- *
- * @param v_step_cnt_s16 : The value of step counter output
- *
- *
- *
- * @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 to 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[BMI160_STEP_COUNT_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_STEP_COUNTER_LENGTH);
- *v_step_cnt_s16 = (s16)
- ((((s32)((s8)a_data_u8r[BMI160_STEP_COUNT_MSB_BYTE]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8r[BMI160_STEP_COUNT_LSB_BYTE]));
- }
- return com_rslt;
- }
- /*!
- * @brief This API reads
- * step counter configuration
- * from the register 0x7A bit 0 to 7
- * and also from the register 0x7B bit 0 to 2 and 4 to 7
- *
- *
- * @param v_step_config_u16 : The value of step counter 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r = BMI160_INIT_VALUE;
- u8 v_data2_u8r = BMI160_INIT_VALUE;
- u16 v_data3_u8r = BMI160_INIT_VALUE;
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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_BIT_POSITION_BY_08_BITS) | (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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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_BIT_POSITION_BY_08_BITS) | (v_data3_u8r)));
- return com_rslt;
- }
- /*!
- * @brief This API writes the
- * step counter configuration
- * in the register 0x7A bit 0 to 7
- * and also in 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_set_step_config(
- u16 v_step_config_u16)
- {
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data1_u8r = BMI160_INIT_VALUE;
- u8 v_data2_u8r = BMI160_INIT_VALUE;
- u16 v_data3_u16 = BMI160_INIT_VALUE;
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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_BIT_POSITION_BY_08_BITS);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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_BIT_POSITION_BY_12_BITS);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g != BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to get the step counter enable/disable status
- * 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_step_counter_u8 = BMI160_GET_BITSLICE(v_data_u8,
- BMI160_USER_STEP_CONFIG_1_STEP_COUNT_ENABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to enable step counter
- * by setting 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- if (p_bmi160 == BMI160_NULL) {
- return E_BMI160_NULL_PTR;
- } else {
- if (v_step_counter_u8 <= BMI160_MAX_GYRO_STEP_COUNTER) {
- /* 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*Accel and Gyro power mode check*/
- if (bmi160_power_mode_status_u8_g !=
- BMI160_NORMAL_MODE)
- /*interface idle time delay */
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- }
- } else {
- com_rslt = E_BMI160_OUT_OF_RANGE;
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to 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 to 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(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_STEP_SENSITIVE_MODE:
- com_rslt = bmi160_set_step_config(
- STEP_CONFIG_SENSITIVE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_STEP_ROBUST_MODE:
- com_rslt = bmi160_set_step_config(
- STEP_CONFIG_ROBUST);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This API is 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_sig_motion_u8 = BMI160_INIT_VALUE;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 v_any_motion_intr1_stat_u8 = BMI160_ENABLE_ANY_MOTION_INTR1;
- u8 v_any_motion_intr2_stat_u8 = BMI160_ENABLE_ANY_MOTION_INTR2;
- u8 v_any_motion_axis_stat_u8 = BMI160_ENABLE_ANY_MOTION_AXIS;
- /* enable the significant motion interrupt */
- com_rslt = bmi160_get_intr_significant_motion_select(&v_sig_motion_u8);
- if (v_sig_motion_u8 != BMI160_SIG_MOTION_STAT_HIGH)
- com_rslt += bmi160_set_intr_significant_motion_select(
- BMI160_SIG_MOTION_INTR_ENABLE);
- switch (v_significant_u8) {
- case BMI160_MAP_INTR1:
- /* interrupt */
- com_rslt += bmi160_read_reg(
- BMI160_USER_INTR_MAP_0_INTR1_ANY_MOTION__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- v_data_u8 |= v_any_motion_intr1_stat_u8;
- /* map the signification interrupt to any-motion interrupt1*/
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_MAP_0_INTR1_ANY_MOTION__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* axis*/
- com_rslt = bmi160_read_reg(BMI160_USER_INTR_ENABLE_0_ADDR,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- v_data_u8 |= v_any_motion_axis_stat_u8;
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_ENABLE_0_ADDR,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_MAP_INTR2:
- /* map the signification interrupt to any-motion interrupt2*/
- com_rslt += bmi160_read_reg(
- BMI160_USER_INTR_MAP_2_INTR2_ANY_MOTION__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- v_data_u8 |= v_any_motion_intr2_stat_u8;
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_MAP_2_INTR2_ANY_MOTION__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* axis*/
- com_rslt = bmi160_read_reg(BMI160_USER_INTR_ENABLE_0_ADDR,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- v_data_u8 |= v_any_motion_axis_stat_u8;
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_ENABLE_0_ADDR,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This API is 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_step_det_u8 = BMI160_INIT_VALUE;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 v_low_g_intr_u81_stat_u8 = BMI160_LOW_G_INTR_STAT;
- u8 v_low_g_intr_u82_stat_u8 = BMI160_LOW_G_INTR_STAT;
- /* 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 != BMI160_STEP_DET_STAT_HIGH)
- com_rslt += bmi160_set_step_detector_enable(
- BMI160_STEP_DETECT_INTR_ENABLE);
- switch (v_step_detector_u8) {
- case BMI160_MAP_INTR1:
- com_rslt += bmi160_read_reg(
- BMI160_USER_INTR_MAP_0_INTR1_LOW_G__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- v_data_u8 |= v_low_g_intr_u81_stat_u8;
- /* 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_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_MAP_INTR2:
- /* map the step detector interrupt
- to Low-g interrupt 2*/
- com_rslt += bmi160_read_reg(
- BMI160_USER_INTR_MAP_2_INTR2_LOW_G__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- v_data_u8 |= v_low_g_intr_u82_stat_u8;
- com_rslt += bmi160_write_reg(
- BMI160_USER_INTR_MAP_2_INTR2_LOW_G__REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to clear the step counter 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 to 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(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- return com_rslt;
- }
- /*!
- * @brief This API writes the 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 Accel to suspend
- * 0x11 | Sets the PMU mode for the Accel to normal
- * 0x12 | Sets the PMU mode for the Accel Lowpower
- * 0x14 | Sets the PMU mode for the Gyro to suspend
- * 0x15 | Sets the PMU mode for the Gyro to normal
- * 0x16 | Reserved
- * 0x17 | Sets the PMU mode for the Gyro to fast start-up
- * 0x18 | Sets the PMU mode for the Mag to suspend
- * 0x19 | Sets the PMU mode for the Mag to normal
- * 0x1A | Sets the PMU mode for the Mag 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
- *
- * @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 for NULL pointer assignment*/
- 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, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /*interface idle time delay */
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /*power mode status of Accel and gyro is stored in the
- global variable bmi160_power_mode_status_u8_g */
- com_rslt += bmi160_read_reg(BMI160_USER_PMU_STAT_ADDR,
- &bmi160_power_mode_status_u8_g,
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- bmi160_power_mode_status_u8_g &=
- BMI160_ACCEL_GYRO_PMU_MASK;
- }
- return com_rslt;
- }
- /*!
- * @brief This function is used to read the compensated xyz axis data of
- * mag secondary interface
- * @note v_mag_x_s16: The value of Mag x data
- * @note v_mag_y_s16: The value of Mag y data
- * @note v_mag_z_s16: The value of Mag z data
- * @note v_mag_r_s16: The value of Mag r data
- * @param v_mag_second_if_u8: The value of Mag selection
- *
- * value | v_mag_second_if_u8
- * ---------|----------------------
- * 0 | BMM150
- * 1 | AKM09911
- * 2 | AKM09912
- * 3 | YAS532
- * 4 | YAS537
- * @param mag_fifo_data: The value of compensated Mag xyz data
- *
- *
- * @return
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_second_if_mag_compensate_xyz(
- struct bmi160_mag_fifo_data_t mag_fifo_data,
- u8 v_mag_second_if_u8)
- {
- s8 com_rslt = BMI160_INIT_VALUE;
- s16 v_mag_x_s16 = BMI160_INIT_VALUE;
- s16 v_mag_y_s16 = BMI160_INIT_VALUE;
- s16 v_mag_z_s16 = BMI160_INIT_VALUE;
- u16 v_mag_r_u16 = BMI160_INIT_VALUE;
- #ifdef YAS537
- u8 v_outflow_u8 = BMI160_INIT_VALUE;
- u8 v_busy_u8 = BMI160_INIT_VALUE;
- u8 v_coil_stat_u8 = BMI160_INIT_VALUE;
- u16 v_temperature_u16 = BMI160_INIT_VALUE;
- s32 a_h_s32[BMI160_YAS_H_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- s32 a_s_s32[BMI160_YAS_S_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- u16 xy1y2[3] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- #endif
- #ifdef YAS532
- u16 v_xy1y2_u16[3] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- u8 v_busy_yas532_u8 = BMI160_INIT_VALUE;
- u16 v_temp_yas532_u16 = BMI160_INIT_VALUE;
- u8 v_overflow_yas532_u8 = BMI160_INIT_VALUE;
- #endif
- switch (v_mag_second_if_u8) {
- case BMI160_SEC_IF_BMM150:
- /* x data*/
- v_mag_x_s16 = (s16)((mag_fifo_data.mag_x_msb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (mag_fifo_data.mag_x_lsb));
- v_mag_x_s16 = (s16)
- (v_mag_x_s16 >> BMI160_SHIFT_BIT_POSITION_BY_03_BITS);
- /* y data*/
- v_mag_y_s16 = (s16)((mag_fifo_data.mag_y_msb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (mag_fifo_data.mag_y_lsb));
- v_mag_y_s16 = (s16)
- (v_mag_y_s16 >> BMI160_SHIFT_BIT_POSITION_BY_03_BITS);
- /* z data*/
- v_mag_z_s16 = (s16)((mag_fifo_data.mag_z_msb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (mag_fifo_data.mag_z_lsb));
- v_mag_z_s16 = (s16)
- (v_mag_z_s16 >> BMI160_SHIFT_BIT_POSITION_BY_01_BIT);
- /* r data*/
- v_mag_r_u16 = (u16)((mag_fifo_data.mag_r_y2_msb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (mag_fifo_data.mag_r_y2_lsb));
- v_mag_r_u16 = (u16)
- (v_mag_r_u16 >> BMI160_SHIFT_BIT_POSITION_BY_02_BITS);
- /* Compensated Mag x data */
- processed_data.x =
- bmi160_bmm150_mag_compensate_X(v_mag_x_s16,
- v_mag_r_u16);
- /* Compensated Mag y data */
- processed_data.y =
- bmi160_bmm150_mag_compensate_Y(v_mag_y_s16,
- v_mag_r_u16);
- /* Compensated Mag z data */
- processed_data.z =
- bmi160_bmm150_mag_compensate_Z(v_mag_z_s16,
- v_mag_r_u16);
- break;
- #ifdef AKM09911
- case BMI160_SEC_IF_AKM09911:
- /* x data*/
- v_mag_x_s16 = (s16)((mag_fifo_data.mag_x_msb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (mag_fifo_data.mag_x_lsb));
- /* y data*/
- v_mag_y_s16 = (s16)((mag_fifo_data.mag_y_msb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (mag_fifo_data.mag_y_lsb));
- /* z data*/
- v_mag_z_s16 = (s16)((mag_fifo_data.mag_z_msb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (mag_fifo_data.mag_z_lsb));
- /* Compensated for X data */
- processed_data.x =
- bmi160_bst_akm09911_compensate_X(v_mag_x_s16);
- /* Compensated for Y data */
- processed_data.y =
- bmi160_bst_akm09911_compensate_Y(v_mag_y_s16);
- /* Compensated for Z data */
- processed_data.z =
- bmi160_bst_akm09911_compensate_Z(v_mag_z_s16);
- break;
- #endif
- #ifdef AKM09912
- case BMI160_SEC_IF_AKM09912:
- /* x data*/
- v_mag_x_s16 = (s16)((mag_fifo_data.mag_x_msb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (mag_fifo_data.mag_x_lsb));
- /* y data*/
- v_mag_y_s16 = (s16)((mag_fifo_data.mag_y_msb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (mag_fifo_data.mag_y_lsb));
- /* z data*/
- v_mag_z_s16 = (s16)((mag_fifo_data.mag_z_msb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (mag_fifo_data.mag_z_lsb));
- /* Compensated for X data */
- processed_data.x =
- bmi160_bst_akm09912_compensate_X(v_mag_x_s16);
- /* Compensated for Y data */
- processed_data.y =
- bmi160_bst_akm09912_compensate_Y(v_mag_y_s16);
- /* Compensated for Z data */
- processed_data.z =
- bmi160_bst_akm09912_compensate_Z(v_mag_z_s16);
- break;
- #endif
- #ifdef YAS532
- case BMI160_SEC_IF_YAS532:{
- u8 i = BMI160_INIT_VALUE;
- /* read the xyy1 data*/
- v_busy_yas532_u8 =
- ((mag_fifo_data.mag_x_lsb
- >> BMI160_SHIFT_BIT_POSITION_BY_07_BITS) & 0x01);
- v_temp_yas532_u16 =
- (u16)((((s32)mag_fifo_data.mag_x_lsb
- << BMI160_SHIFT_BIT_POSITION_BY_03_BITS)
- & 0x3F8) | ((mag_fifo_data.mag_x_msb
- >> BMI160_SHIFT_BIT_POSITION_BY_05_BITS) & 0x07));
- v_xy1y2_u16[0] =
- (u16)((((s32)mag_fifo_data.mag_y_lsb
- << BMI160_SHIFT_BIT_POSITION_BY_06_BITS) & 0x1FC0)
- | ((mag_fifo_data.mag_y_msb >>
- BMI160_SHIFT_BIT_POSITION_BY_02_BITS) & 0x3F));
- v_xy1y2_u16[1] =
- (u16)((((s32)mag_fifo_data.mag_z_lsb
- << BMI160_SHIFT_BIT_POSITION_BY_06_BITS)
- & 0x1FC0)
- | ((mag_fifo_data.mag_z_msb
- >> BMI160_SHIFT_BIT_POSITION_BY_02_BITS) & 0x3F));
- v_xy1y2_u16[2] =
- (u16)((((s32)mag_fifo_data.mag_r_y2_lsb
- << BMI160_SHIFT_BIT_POSITION_BY_06_BITS)
- & 0x1FC0)
- | ((mag_fifo_data.mag_r_y2_msb
- >> BMI160_SHIFT_BIT_POSITION_BY_02_BITS) & 0x3F));
- v_overflow_yas532_u8 = 0;
- for (i = 0; i < 3; i++) {
- if (v_xy1y2_u16[i] == YAS532_DATA_OVERFLOW)
- v_overflow_yas532_u8 |= (1 << (i * 2));
- if (v_xy1y2_u16[i] == YAS532_DATA_UNDERFLOW)
- v_overflow_yas532_u8 |= (1 << (i * 2 + 1));
- }
- /* assign the data*/
- com_rslt = bmi160_bst_yas532_fifo_xyz_data(
- v_xy1y2_u16, 1, v_overflow_yas532_u8,
- v_temp_yas532_u16, v_busy_yas532_u8);
- processed_data.x =
- fifo_xyz_data.yas532_vector_xyz[0];
- processed_data.y =
- fifo_xyz_data.yas532_vector_xyz[1];
- processed_data.z =
- fifo_xyz_data.yas532_vector_xyz[2];
- }
- break;
- #endif
- #ifdef YAS537
- case BMI160_SEC_IF_YAS537:{
- u8 i = BMI160_INIT_VALUE;
- /* read the busy flag*/
- v_busy_u8 = mag_fifo_data.mag_y_lsb
- >> BMI160_SHIFT_BIT_POSITION_BY_07_BITS;
- /* read the coil status*/
- v_coil_stat_u8 =
- ((mag_fifo_data.mag_y_lsb >>
- BMI160_SHIFT_BIT_POSITION_BY_06_BITS) & 0X01);
- /* read temperature data*/
- v_temperature_u16 = (u16)((mag_fifo_data.mag_x_lsb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | mag_fifo_data.mag_x_msb);
- /* read x data*/
- xy1y2[0] = (u16)(((mag_fifo_data.mag_y_lsb &
- 0x3F)
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (mag_fifo_data.mag_y_msb));
- /* read y1 data*/
- xy1y2[1] = (u16)((mag_fifo_data.mag_z_lsb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | mag_fifo_data.mag_z_msb);
- /* read y2 data*/
- xy1y2[2] = (u16)((mag_fifo_data.mag_r_y2_lsb
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | mag_fifo_data.mag_r_y2_msb);
- for (i = 0; i < 3; i++)
- yas537_data.last_raw[i] = xy1y2[i];
- yas537_data.last_raw[i] = v_temperature_u16;
- if (yas537_data.calib_yas537.ver == 1) {
- for (i = 0; i < 3; i++)
- a_s_s32[i] = xy1y2[i] - 8192;
- /* read hx*/
- a_h_s32[0] = ((yas537_data.calib_yas537.k * (
- (128 * a_s_s32[0]) +
- (yas537_data.calib_yas537.a2 * a_s_s32[1]) +
- (yas537_data.calib_yas537.a3 * a_s_s32[2])))
- / (8192));
- /* read hy1*/
- a_h_s32[1] = ((yas537_data.calib_yas537.k * (
- (yas537_data.calib_yas537.a4 * a_s_s32[0]) +
- (yas537_data.calib_yas537.a5 * a_s_s32[1]) +
- (yas537_data.calib_yas537.a6 * a_s_s32[2])))
- / (8192));
- /* read hy2*/
- a_h_s32[2] = ((yas537_data.calib_yas537.k * (
- (yas537_data.calib_yas537.a7 * a_s_s32[0]) +
- (yas537_data.calib_yas537.a8 * a_s_s32[1]) +
- (yas537_data.calib_yas537.a9 * a_s_s32[2])))
- / (8192));
- for (i = 0; i < 3; i++) {
- if (a_h_s32[i] < -8192)
- a_h_s32[i] = -8192;
- if (8192 < a_h_s32[i])
- a_h_s32[i] = 8192;
- xy1y2[i] = a_h_s32[i] + 8192;
- }
- }
- v_outflow_u8 = 0;
- for (i = 0; i < 3; i++) {
- if (YAS537_DATA_OVERFLOW
- <= xy1y2[i])
- v_outflow_u8 |=
- (1 << (i * 2));
- if (xy1y2[i] ==
- YAS537_DATA_UNDERFLOW)
- v_outflow_u8
- |= (1 << (i * 2 + 1));
- }
- com_rslt = bmi160_bst_yamaha_yas537_fifo_xyz_data(
- xy1y2, v_outflow_u8, v_coil_stat_u8, v_busy_u8);
- processed_data.x =
- fifo_vector_xyz.yas537_vector_xyz[0];
- processed_data.y =
- fifo_vector_xyz.yas537_vector_xyz[1];
- processed_data.z =
- fifo_vector_xyz.yas537_vector_xyz[2];
- }
- break;
- #endif
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- return com_rslt;
- }
- #ifdef FIFO_ENABLE
- /*!
- * @brief This function is used to read the
- * fifo data of header mode
- *
- *
- * @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(u8 v_mag_if_u8,
- struct bmi160_fifo_data_header_t *header_data)
- {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* read the whole FIFO data*/
- com_rslt =
- bmi160_read_fifo_header_data_user_defined_length(
- FIFO_FRAME, v_mag_if_u8, header_data);
- return com_rslt;
- }
- /*!
- * @brief This function is used to read the
- * fifo data of header mode for user defined 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_user_defined_length(
- u16 v_fifo_user_length_u16, u8 v_mag_if_mag_u8,
- struct bmi160_fifo_data_header_t *fifo_header_data)
- {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_accel_index_u8 = BMI160_INIT_VALUE;
- u8 v_gyro_index_u8 = BMI160_INIT_VALUE;
- u8 v_mag_index_u8 = BMI160_INIT_VALUE;
- s8 v_last_return_stat_s8 = BMI160_INIT_VALUE;
- u16 v_fifo_index_u16 = BMI160_INIT_VALUE;
- u8 v_frame_head_u8 = BMI160_INIT_VALUE;
- u8 v_frame_index_u8 = BMI160_INIT_VALUE;
- u16 v_fifo_length_u16 = BMI160_INIT_VALUE;
- fifo_header_data->accel_frame_count = BMI160_INIT_VALUE;
- fifo_header_data->mag_frame_count = BMI160_INIT_VALUE;
- fifo_header_data->gyro_frame_count = BMI160_INIT_VALUE;
- /* read FIFO data*/
- com_rslt = bmi160_fifo_data(&v_fifo_data_u8[BMI160_INIT_VALUE],
- v_fifo_user_length_u16);
- v_fifo_length_u16 = v_fifo_user_length_u16;
- for (v_fifo_index_u16 = BMI160_INIT_VALUE;
- v_fifo_index_u16 < v_fifo_length_u16;) {
- fifo_header_data->fifo_header[v_frame_index_u8]
- = v_fifo_data_u8[v_fifo_index_u16];
- v_frame_head_u8 =
- fifo_header_data->fifo_header[v_frame_index_u8]
- & BMI160_FIFO_TAG_INTR_MASK;
- v_frame_index_u8++;
- switch (v_frame_head_u8) {
- /* Header frame of Accel */
- case FIFO_HEAD_A:
- { /*fifo data frame index + 1*/
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_INDEX_LENGTH;
- if ((v_fifo_index_u16 + BMI160_FIFO_A_LENGTH)
- > v_fifo_length_u16) {
- v_last_return_stat_s8 = FIFO_A_OVER_LEN;
- break;
- }
- /* Accel raw x data */
- fifo_header_data->accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_MSB_DATA])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_LSB_DATA]));
- /* Accel raw y data */
- fifo_header_data->accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_MSB_DATA])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_LSB_DATA]));
- /* Accel raw z data */
- fifo_header_data->accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_MSB_DATA])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_LSB_DATA]));
- /* check for Accel frame count*/
- fifo_header_data->accel_frame_count =
- fifo_header_data->accel_frame_count
- + BMI160_FRAME_COUNT;
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_A_LENGTH;
- v_accel_index_u8++;
- break;
- }
- /* Header frame of gyro */
- case FIFO_HEAD_G:
- { /*fifo data frame index + 1*/
- v_fifo_index_u16 = v_fifo_index_u16
- + BMI160_FIFO_INDEX_LENGTH;
- if ((v_fifo_index_u16 + BMI160_FIFO_G_LENGTH) >
- v_fifo_length_u16) {
- v_last_return_stat_s8 = FIFO_G_OVER_LEN;
- break;
- }
- /* Gyro raw x data */
- fifo_header_data->gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_MSB_DATA])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_LSB_DATA]));
- /* Gyro raw y data */
- fifo_header_data->gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_MSB_DATA])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_LSB_DATA]));
- /* Gyro raw z data */
- fifo_header_data->gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_MSB_DATA])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_LSB_DATA]));
- /* check for gyro frame count*/
- fifo_header_data->gyro_frame_count =
- fifo_header_data->gyro_frame_count + BMI160_FRAME_COUNT;
- /*fifo G data frame index + 6*/
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_G_LENGTH;
- v_gyro_index_u8++;
- break;
- }
- /* Header frame of Mag */
- case FIFO_HEAD_M:
- { /*fifo data frame index + 1*/
- v_fifo_index_u16 = v_fifo_index_u16
- + BMI160_FIFO_INDEX_LENGTH;
- if ((v_fifo_index_u16 + BMI160_FIFO_M_LENGTH) >
- (v_fifo_length_u16)) {
- v_last_return_stat_s8 = FIFO_M_OVER_LEN;
- break;
- }
- /* Mag x data*/
- mag_data.mag_x_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_LSB_DATA]);
- mag_data.mag_x_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_MSB_DATA]);
- /* Mag y data*/
- mag_data.mag_y_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_LSB_DATA]);
- mag_data.mag_y_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_MSB_DATA]);
- mag_data.mag_z_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_LSB_DATA]);
- mag_data.mag_z_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_MSB_DATA]);
- /* Mag r data*/
- mag_data.mag_r_y2_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_LSB_DATA]);
- mag_data.mag_r_y2_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_MSB_DATA]);
- com_rslt = bmi160_second_if_mag_compensate_xyz(mag_data,
- v_mag_if_mag_u8);
- /* compensated Mag x */
- fifo_header_data->mag_fifo[v_gyro_index_u8].x
- = processed_data.x;
- /* compensated Mag y */
- fifo_header_data->mag_fifo[v_gyro_index_u8].y
- = processed_data.y;
- /* compensated Mag z */
- fifo_header_data->mag_fifo[v_gyro_index_u8].z
- = processed_data.z;
- /* check for Mag frame count*/
- fifo_header_data->mag_frame_count =
- fifo_header_data->mag_frame_count
- + BMI160_FRAME_COUNT;
- v_mag_index_u8++;
- /*fifo M data frame index + 8*/
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_M_LENGTH;
- break;
- }
- /* Header frame of gyro and Accel */
- case FIFO_HEAD_G_A:
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_INDEX_LENGTH;
- if ((v_fifo_index_u16 + BMI160_FIFO_AG_LENGTH)
- > v_fifo_length_u16) {
- v_last_return_stat_s8 = FIFO_G_A_OVER_LEN;
- break;
- }
- /* Raw gyro x */
- fifo_header_data->gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_G_X_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_G_X_LSB]));
- /* Raw gyro y */
- fifo_header_data->gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_G_Y_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_G_Y_LSB]));
- /* Raw gyro z */
- fifo_header_data->gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_G_Z_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_G_Z_LSB]));
- /* check for gyro frame count*/
- fifo_header_data->gyro_frame_count =
- fifo_header_data->gyro_frame_count + BMI160_FRAME_COUNT;
- /* Raw Accel x */
- fifo_header_data->accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_A_X_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_A_X_LSB]));
- /* Raw Accel y */
- fifo_header_data->accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_A_Y_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_A_Y_LSB]));
- /* Raw Accel z */
- fifo_header_data->accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_A_Z_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16
- + BMI160_GA_FIFO_A_Z_LSB]));
- /* check for Accel frame count*/
- fifo_header_data->accel_frame_count =
- fifo_header_data->accel_frame_count
- + BMI160_FRAME_COUNT;
- /* Index added to 12 for gyro and Accel*/
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_AG_LENGTH;
- v_gyro_index_u8++;
- v_accel_index_u8++;
- break;
- /* Header frame of mag, gyro and Accel */
- case FIFO_HEAD_M_G_A:
- { /*fifo data frame index + 1*/
- v_fifo_index_u16 = v_fifo_index_u16
- + BMI160_FIFO_INDEX_LENGTH;
- if ((v_fifo_index_u16 + BMI160_FIFO_AMG_LENGTH)
- > (v_fifo_length_u16)) {
- v_last_return_stat_s8 = FIFO_M_G_A_OVER_LEN;
- break;
- }
- /* Mag x data*/
- mag_data.mag_x_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_LSB_DATA]);
- mag_data.mag_x_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_MSB_DATA]);
- /* Mag y data*/
- mag_data.mag_y_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_LSB_DATA]);
- mag_data.mag_y_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_MSB_DATA]);
- mag_data.mag_z_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_LSB_DATA]);
- mag_data.mag_z_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_MSB_DATA]);
- /* Mag r data*/
- mag_data.mag_r_y2_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_LSB_DATA]);
- mag_data.mag_r_y2_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_MSB_DATA]);
- /* Processing the compensation data*/
- com_rslt = bmi160_second_if_mag_compensate_xyz(mag_data,
- v_mag_if_mag_u8);
- /* compensated Mag x */
- fifo_header_data->mag_fifo[v_mag_index_u8].x =
- processed_data.x;
- /* compensated Mag y */
- fifo_header_data->mag_fifo[v_mag_index_u8].y =
- processed_data.y;
- /* compensated Mag z */
- fifo_header_data->mag_fifo[v_mag_index_u8].z =
- processed_data.z;
- /* check for Mag frame count*/
- fifo_header_data->mag_frame_count =
- fifo_header_data->mag_frame_count + BMI160_FRAME_COUNT;
- /* Gyro raw x data */
- fifo_header_data->gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_G_X_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_G_X_LSB]));
- /* Gyro raw y data */
- fifo_header_data->gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u16 + BMI160_MGA_FIFO_G_Y_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_G_Y_LSB]));
- /* Gyro raw z data */
- fifo_header_data->gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u16 + BMI160_MGA_FIFO_G_Z_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[
- v_fifo_index_u16 + BMI160_MGA_FIFO_G_Z_LSB]));
- /* check for gyro frame count*/
- fifo_header_data->gyro_frame_count =
- fifo_header_data->gyro_frame_count + BMI160_FRAME_COUNT;
- /* Accel raw x data */
- fifo_header_data->accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u16 + BMI160_MGA_FIFO_A_X_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_A_X_LSB]));
- /* Accel raw y data */
- fifo_header_data->accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u16 + BMI160_MGA_FIFO_A_Y_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_A_Y_LSB]));
- /* Accel raw z data */
- fifo_header_data->accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[
- v_fifo_index_u16 + BMI160_MGA_FIFO_A_Z_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_A_Z_LSB]));
- /* check for Accel frame count*/
- fifo_header_data->accel_frame_count =
- fifo_header_data->accel_frame_count
- + BMI160_FRAME_COUNT;
- /* Index added to 20 for mag, gyro and Accel*/
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_AMG_LENGTH;
- 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 data frame index + 1*/
- v_fifo_index_u16 = v_fifo_index_u16
- + BMI160_GEN_READ_WRITE_DATA_LENGTH;
- if ((v_fifo_index_u16 + BMI160_FIFO_MA_OR_MG_LENGTH)
- > (v_fifo_length_u16)) {
- v_last_return_stat_s8 = FIFO_M_A_OVER_LEN;
- break;
- }
- /* Mag x data*/
- mag_data.mag_x_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_LSB_DATA]);
- mag_data.mag_x_msb = (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_MSB_DATA]);
- /* Mag y data*/
- mag_data.mag_y_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_LSB_DATA]);
- mag_data.mag_y_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_MSB_DATA]);
- mag_data.mag_z_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_LSB_DATA]);
- mag_data.mag_z_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_MSB_DATA]);
- /* Mag r data*/
- mag_data.mag_r_y2_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_LSB_DATA]);
- mag_data.mag_r_y2_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_MSB_DATA]);
- com_rslt =
- bmi160_second_if_mag_compensate_xyz(mag_data,
- v_mag_if_mag_u8);
- /* compensated Mag x */
- fifo_header_data->mag_fifo[v_mag_index_u8].x =
- processed_data.x;
- /* compensated Mag y */
- fifo_header_data->mag_fifo[v_mag_index_u8].y =
- processed_data.y;
- /* compensated Mag z */
- fifo_header_data->mag_fifo[v_mag_index_u8].z =
- processed_data.z;
- /* check for Mag frame count*/
- fifo_header_data->mag_frame_count =
- fifo_header_data->mag_frame_count
- + BMI160_FRAME_COUNT;
- /* Accel raw x data */
- fifo_header_data->accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MA_FIFO_A_X_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MA_FIFO_A_X_LSB]));
- /* Accel raw y data */
- fifo_header_data->accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MA_FIFO_A_Y_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MA_FIFO_A_Y_LSB]));
- /* Accel raw z data */
- fifo_header_data->accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MA_FIFO_A_Z_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MA_FIFO_A_Z_LSB]));
- /* check for Accel frame count*/
- fifo_header_data->accel_frame_count =
- fifo_header_data->accel_frame_count
- + BMI160_FRAME_COUNT;
- /*fifo AM data frame index + 14(8+6)*/
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_MA_OR_MG_LENGTH;
- v_accel_index_u8++;
- v_mag_index_u8++;
- break;
- }
- /* Header frame of Mag and gyro */
- case FIFO_HEAD_M_G:
- {
- /*fifo data frame index + 1*/
- v_fifo_index_u16 = v_fifo_index_u16
- + BMI160_GEN_READ_WRITE_DATA_LENGTH;
- if ((v_fifo_index_u16 + BMI160_FIFO_MA_OR_MG_LENGTH)
- > v_fifo_length_u16) {
- v_last_return_stat_s8 = FIFO_M_G_OVER_LEN;
- break;
- }
- /* Mag x data*/
- mag_data.mag_x_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_LSB_DATA]);
- mag_data.mag_x_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_MSB_DATA]);
- /* Mag y data*/
- mag_data.mag_y_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_LSB_DATA]);
- mag_data.mag_y_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_MSB_DATA]);
- mag_data.mag_z_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_LSB_DATA]);
- mag_data.mag_z_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_MSB_DATA]);
- /* Mag r data*/
- mag_data.mag_r_y2_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_LSB_DATA]);
- mag_data.mag_r_y2_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_MSB_DATA]);
- com_rslt =
- bmi160_second_if_mag_compensate_xyz(mag_data,
- v_mag_if_mag_u8);
- /* compensated Mag x */
- fifo_header_data->mag_fifo[v_mag_index_u8].x =
- processed_data.x;
- /* compensated Mag y */
- fifo_header_data->mag_fifo[v_mag_index_u8].y =
- processed_data.y;
- /* compensated Mag z */
- fifo_header_data->mag_fifo[v_mag_index_u8].z =
- processed_data.z;
- /* check for Mag frame count*/
- fifo_header_data->mag_frame_count =
- fifo_header_data->mag_frame_count + BMI160_FRAME_COUNT;
- /* Gyro raw x data */
- fifo_header_data->gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MG_FIFO_G_X_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MG_FIFO_G_X_LSB]));
- /* Gyro raw y data */
- fifo_header_data->gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MG_FIFO_G_Y_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MG_FIFO_G_Y_LSB]));
- /* Gyro raw z data */
- fifo_header_data->gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MG_FIFO_G_Z_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MG_FIFO_G_Z_LSB]));
- /* check for gyro frame count*/
- fifo_header_data->gyro_frame_count =
- fifo_header_data->gyro_frame_count
- + BMI160_FRAME_COUNT;
- /*fifo GM data frame index + 14(8+6)*/
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_MA_OR_MG_LENGTH;
- v_mag_index_u8++;
- v_gyro_index_u8++;
- break;
- }
- /* Header frame of sensor time */
- case FIFO_HEAD_SENSOR_TIME:
- {
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_GEN_READ_WRITE_DATA_LENGTH;
- if ((v_fifo_index_u16
- + BMI160_FIFO_SENSOR_TIME_LENGTH) >
- (v_fifo_length_u16)) {
- v_last_return_stat_s8
- = FIFO_SENSORTIME_RETURN;
- break;
- }
- /* Sensor time */
- fifo_header_data->fifo_time = (u32)
- ((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_SENSOR_TIME_MSB]
- << BMI160_SHIFT_BIT_POSITION_BY_16_BITS) |
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_SENSOR_TIME_XLSB]
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) |
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_SENSOR_TIME_LSB]));
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_SENSOR_TIME_LENGTH;
- break;
- }
- /* Header frame of skip frame */
- case FIFO_HEAD_SKIP_FRAME:
- {
- /*fifo data frame index + 1*/
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_INDEX_LENGTH;
- if (v_fifo_index_u16
- + BMI160_FIFO_INDEX_LENGTH
- > v_fifo_length_u16) {
- v_last_return_stat_s8 =
- FIFO_SKIP_OVER_LEN;
- break;
- }
- fifo_header_data->skip_frame =
- v_fifo_data_u8[v_fifo_index_u16];
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_INDEX_LENGTH;
- break;
- }
- case FIFO_HEAD_INPUT_CONFIG:
- {
- /*fifo data frame index + 1*/
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_INDEX_LENGTH;
- if (v_fifo_index_u16
- + BMI160_FIFO_INDEX_LENGTH
- > v_fifo_length_u16) {
- v_last_return_stat_s8 =
- FIFO_INPUT_CONFIG_OVER_LEN;
- break;
- }
- fifo_header_data->fifo_input_config_info
- = v_fifo_data_u8[v_fifo_index_u16];
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_INDEX_LENGTH;
- break;
- }
- /* Header frame of over read FIFO data */
- case FIFO_HEAD_OVER_READ_LSB:
- {
- /*fifo data frame index + 1*/
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_INDEX_LENGTH;
- if ((v_fifo_index_u16 + BMI160_FIFO_INDEX_LENGTH)
- > (v_fifo_length_u16)) {
- v_last_return_stat_s8 = FIFO_OVER_READ_RETURN;
- break;
- }
- if (v_fifo_data_u8[v_fifo_index_u16] ==
- FIFO_HEAD_OVER_READ_MSB) {
- /*fifo over read frame index + 1*/
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_INDEX_LENGTH;
- break;
- } else {
- v_last_return_stat_s8 = FIFO_OVER_READ_RETURN;
- break;
- }
- }
- default:
- v_last_return_stat_s8 = BMI160_FIFO_INDEX_LENGTH;
- break;
- }
- if (v_last_return_stat_s8 != 0)
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This function is used to read the
- * fifo data for header less mode
- *
- *
- *
- * @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(
- u8 v_mag_if_u8, struct bmi160_fifo_data_header_less_t *headerless_data) {
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* read the whole FIFO data*/
- com_rslt =
- bmi160_read_fifo_headerless_mode_user_defined_length(
- FIFO_FRAME, headerless_data, v_mag_if_u8);
- return com_rslt;
- }
- /*!
- * @brief This function is used to read the
- * fifo data for header less mode according to user defined length
- *
- *
- * @param v_fifo_user_length_u16: length of FIFO data to be read
- * @param v_mag_if_mag_u8 : the Mag interface data
- * @param fifo_data : the pointer to fifo_data_header_less_t structure
- *
- * @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_user_defined_length(
- u16 v_fifo_user_length_u16,
- struct bmi160_fifo_data_header_less_t *fifo_data,
- u8 v_mag_if_mag_u8)
- {
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u32 v_fifo_index_u16 = BMI160_INIT_VALUE;
- u32 v_fifo_length_u16 = BMI160_INIT_VALUE;
- u8 v_accel_index_u8 = BMI160_INIT_VALUE;
- u8 v_gyro_index_u8 = BMI160_INIT_VALUE;
- u8 v_mag_index_u8 = BMI160_INIT_VALUE;
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- fifo_data->accel_frame_count = BMI160_INIT_VALUE;
- fifo_data->mag_frame_count = BMI160_INIT_VALUE;
- fifo_data->gyro_frame_count = BMI160_INIT_VALUE;
- /* disable the header data */
- com_rslt = bmi160_set_fifo_header_enable(BMI160_INIT_VALUE);
- /* read mag, Accel and gyro enable status*/
- com_rslt += bmi160_read_reg(BMI160_USER_FIFO_CONFIG_1_ADDR,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- v_data_u8 = v_data_u8 & BMI160_FIFO_M_G_A_ENABLE;
- /* read the FIFO data of 1024 bytes*/
- com_rslt += bmi160_fifo_data(&v_fifo_data_u8[BMI160_INIT_VALUE],
- v_fifo_user_length_u16);
- v_fifo_length_u16 = v_fifo_user_length_u16;
- /* loop for executing the different conditions */
- for (v_fifo_index_u16 = BMI160_INIT_VALUE;
- v_fifo_index_u16 < v_fifo_length_u16;) {
- /* condition for mag, gyro and Accel enable*/
- if (v_data_u8 == BMI160_FIFO_M_G_A_ENABLE) {
- /* Raw Mag x*/
- mag_data.mag_x_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_LSB_DATA]);
- mag_data.mag_x_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_MSB_DATA]);
- /* Mag y data*/
- mag_data.mag_y_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_LSB_DATA]);
- mag_data.mag_y_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_MSB_DATA]);
- /* Mag z data*/
- mag_data.mag_z_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_LSB_DATA]);
- mag_data.mag_z_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_MSB_DATA]);
- /* Mag r data*/
- mag_data.mag_r_y2_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_LSB_DATA]);
- mag_data.mag_r_y2_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_MSB_DATA]);
- com_rslt =
- bmi160_second_if_mag_compensate_xyz(mag_data,
- v_mag_if_mag_u8);
- /* compensated Mag x */
- fifo_data->mag_fifo[v_mag_index_u8].x =
- processed_data.x;
- /* compensated Mag y */
- fifo_data->mag_fifo[v_mag_index_u8].y =
- processed_data.y;
- /* compensated Mag z */
- fifo_data->mag_fifo[v_mag_index_u8].z =
- processed_data.z;
- /* check for Mag frame count*/
- fifo_data->mag_frame_count =
- fifo_data->mag_frame_count + BMI160_FRAME_COUNT;
- /* Gyro raw x v_data_u8 */
- fifo_data->gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_G_X_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_G_X_LSB]));
- /* Gyro raw y v_data_u8 */
- fifo_data->gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_G_Y_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_G_Y_LSB]));
- /* Gyro raw z v_data_u8 */
- fifo_data->gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_G_Z_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_G_Z_LSB]));
- /* check for gyro frame count*/
- fifo_data->gyro_frame_count =
- fifo_data->gyro_frame_count + BMI160_FRAME_COUNT;
- /* Accel raw x v_data_u8 */
- fifo_data->accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_A_X_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_A_X_LSB]));
- /* Accel raw y v_data_u8 */
- fifo_data->accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_A_Y_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_A_Y_LSB]));
- /* Accel raw z v_data_u8 */
- fifo_data->accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_A_Z_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MGA_FIFO_A_Z_LSB]));
- /* check for Accel frame count*/
- fifo_data->accel_frame_count =
- fifo_data->accel_frame_count + BMI160_FRAME_COUNT;
- v_accel_index_u8++;
- v_mag_index_u8++;
- v_gyro_index_u8++;
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_AMG_LENGTH;
- }
- /* condition for Mag and gyro enable*/
- else if (v_data_u8 == BMI160_FIFO_M_G_ENABLE) {
- /* Raw Mag x*/
- mag_data.mag_x_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_LSB_DATA]);
- mag_data.mag_x_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_MSB_DATA]);
- /* Mag y data*/
- mag_data.mag_y_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_LSB_DATA]);
- mag_data.mag_y_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_MSB_DATA]);
- /* Mag z data*/
- mag_data.mag_z_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_LSB_DATA]);
- mag_data.mag_z_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_MSB_DATA]);
- /* Mag r data*/
- mag_data.mag_r_y2_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_LSB_DATA]);
- mag_data.mag_r_y2_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_MSB_DATA]);
- com_rslt = bmi160_second_if_mag_compensate_xyz(mag_data,
- v_mag_if_mag_u8);
- /* compensated Mag x */
- fifo_data->mag_fifo[v_mag_index_u8].x =
- processed_data.x;
- /* compensated Mag y */
- fifo_data->mag_fifo[v_mag_index_u8].y =
- processed_data.y;
- /* compensated Mag z */
- fifo_data->mag_fifo[v_mag_index_u8].z =
- processed_data.z;
- /* check for Mag frame count*/
- fifo_data->mag_frame_count =
- fifo_data->mag_frame_count + BMI160_FRAME_COUNT;
- /* Gyro raw x v_data_u8 */
- fifo_data->gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MG_FIFO_G_X_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MG_FIFO_G_X_LSB]));
- /* Gyro raw y v_data_u8 */
- fifo_data->gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MG_FIFO_G_Y_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MG_FIFO_G_Y_LSB]));
- /* Gyro raw z v_data_u8 */
- fifo_data->gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MG_FIFO_G_Z_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MG_FIFO_G_Z_LSB]));
- /* check for gyro frame count*/
- fifo_data->gyro_frame_count =
- fifo_data->gyro_frame_count + BMI160_FRAME_COUNT;
- v_gyro_index_u8++;
- v_mag_index_u8++;
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_MA_OR_MG_LENGTH;
- }
- /* condition for Mag and Accel enable*/
- else if (v_data_u8 == BMI160_FIFO_M_A_ENABLE) {
- /* Raw Mag x*/
- mag_data.mag_x_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_LSB_DATA]);
- mag_data.mag_x_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_MSB_DATA]);
- /* Mag y data*/
- mag_data.mag_y_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_LSB_DATA]);
- mag_data.mag_y_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_MSB_DATA]);
- /* Mag z data*/
- mag_data.mag_z_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_LSB_DATA]);
- mag_data.mag_z_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_MSB_DATA]);
- /* Mag r data*/
- mag_data.mag_r_y2_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_LSB_DATA]);
- mag_data.mag_r_y2_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_MSB_DATA]);
- com_rslt = bmi160_second_if_mag_compensate_xyz(mag_data,
- v_mag_if_mag_u8);
- /* compensated Mag x */
- fifo_data->mag_fifo[v_mag_index_u8].x =
- processed_data.x;
- /* compensated Mag y */
- fifo_data->mag_fifo[v_mag_index_u8].y =
- processed_data.y;
- /* compensated Mag z */
- fifo_data->mag_fifo[v_mag_index_u8].z =
- processed_data.z;
- /* check for Mag frame count*/
- fifo_data->mag_frame_count =
- fifo_data->mag_frame_count + BMI160_FRAME_COUNT;
- /* Accel raw x v_data_u8 */
- fifo_data->accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MA_FIFO_A_X_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MA_FIFO_A_X_LSB]));
- /* Accel raw y v_data_u8 */
- fifo_data->accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MA_FIFO_A_Y_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MA_FIFO_A_Y_LSB]));
- /* Accel raw z v_data_u8 */
- fifo_data->accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MA_FIFO_A_Z_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_MA_FIFO_A_Z_LSB]));
- /* check for Accel frame count*/
- fifo_data->accel_frame_count =
- fifo_data->accel_frame_count + BMI160_FRAME_COUNT;
- v_accel_index_u8++;
- v_mag_index_u8++;
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_MA_OR_MG_LENGTH;
- }
- /* condition for gyro and Accel enable*/
- else if (v_data_u8 == BMI160_FIFO_G_A_ENABLE) {
- /* Gyro raw x v_data_u8 */
- fifo_data->gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_G_X_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_G_X_LSB]));
- /* Gyro raw y v_data_u8 */
- fifo_data->gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_G_Y_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_G_Y_LSB]));
- /* Gyro raw z v_data_u8 */
- fifo_data->gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_G_Z_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_G_Z_LSB]));
- /* check for gyro frame count*/
- fifo_data->gyro_frame_count =
- fifo_data->gyro_frame_count + BMI160_FRAME_COUNT;
- /* Accel raw x v_data_u8 */
- fifo_data->accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_A_X_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_A_X_LSB]));
- /* Accel raw y v_data_u8 */
- fifo_data->accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_A_Y_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_A_Y_LSB]));
- /* Accel raw z v_data_u8 */
- fifo_data->accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_A_Z_MSB])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_GA_FIFO_A_Z_LSB]));
- /* check for Accel frame count*/
- fifo_data->accel_frame_count =
- fifo_data->accel_frame_count + BMI160_FRAME_COUNT;
- v_accel_index_u8++;
- v_gyro_index_u8++;
- v_fifo_index_u16 = v_fifo_index_u16 +
- BMI160_FIFO_AG_LENGTH;
- }
- /* condition for gyro enable*/
- else if (v_data_u8 == BMI160_FIFO_GYRO_ENABLE) {
- /* Gyro raw x v_data_u8 */
- fifo_data->gyro_fifo[v_gyro_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16
- + BMI160_FIFO_X_MSB_DATA])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16
- + BMI160_FIFO_X_LSB_DATA]));
- /* Gyro raw y v_data_u8 */
- fifo_data->gyro_fifo[v_gyro_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16
- + BMI160_FIFO_Y_MSB_DATA])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16
- + BMI160_FIFO_Y_LSB_DATA]));
- /* Gyro raw z v_data_u8 */
- fifo_data->gyro_fifo[v_gyro_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16
- + BMI160_FIFO_Z_MSB_DATA])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16
- + BMI160_FIFO_Z_LSB_DATA]));
- /* check for gyro frame count*/
- fifo_data->gyro_frame_count =
- fifo_data->gyro_frame_count + BMI160_FRAME_COUNT;
- v_fifo_index_u16 = v_fifo_index_u16 + BMI160_FIFO_G_LENGTH;
- v_gyro_index_u8++;
- }
- /* condition for Accel enable*/
- else if (v_data_u8 == BMI160_FIFO_A_ENABLE) {
- /* Accel raw x v_data_u8 */
- fifo_data->accel_fifo[v_accel_index_u8].x =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16
- + BMI160_FIFO_X_MSB_DATA])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 + BMI160_FIFO_X_LSB_DATA]));
- /* Accel raw y v_data_u8 */
- fifo_data->accel_fifo[v_accel_index_u8].y =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16
- + BMI160_FIFO_Y_MSB_DATA])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 + BMI160_FIFO_Y_LSB_DATA]));
- /* Accel raw z v_data_u8 */
- fifo_data->accel_fifo[v_accel_index_u8].z =
- (s16)(((v_fifo_data_u8[v_fifo_index_u16
- + BMI160_FIFO_Z_MSB_DATA])
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- |(v_fifo_data_u8[v_fifo_index_u16 + BMI160_FIFO_Z_LSB_DATA]));
- /* check for Accel frame count*/
- fifo_data->accel_frame_count =
- fifo_data->accel_frame_count + BMI160_FRAME_COUNT;
- v_fifo_index_u16 = v_fifo_index_u16 + BMI160_FIFO_A_LENGTH;
- v_accel_index_u8++;
- }
- /* condition for Mag enable*/
- else if (v_data_u8 == BMI160_FIFO_M_ENABLE) {
- /* Raw Mag x*/
- mag_data.mag_x_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_LSB_DATA]);
- mag_data.mag_x_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_X_MSB_DATA]);
- /* Mag y data*/
- mag_data.mag_y_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_LSB_DATA]);
- mag_data.mag_y_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Y_MSB_DATA]);
- /* Mag z data*/
- mag_data.mag_z_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_LSB_DATA]);
- mag_data.mag_z_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_Z_MSB_DATA]);
- /* Mag r data*/
- mag_data.mag_r_y2_lsb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_LSB_DATA]);
- mag_data.mag_r_y2_msb =
- (v_fifo_data_u8[v_fifo_index_u16 +
- BMI160_FIFO_R_MSB_DATA]);
- com_rslt = bmi160_second_if_mag_compensate_xyz(mag_data,
- v_mag_if_mag_u8);
- /* compensated Mag x */
- fifo_data->mag_fifo[v_mag_index_u8].x =
- processed_data.x;
- /* compensated Mag y */
- fifo_data->mag_fifo[v_mag_index_u8].y =
- processed_data.y;
- /* compensated Mag z */
- fifo_data->mag_fifo[v_mag_index_u8].z =
- processed_data.z;
- /* check for Mag frame count*/
- fifo_data->mag_frame_count =
- fifo_data->mag_frame_count + BMI160_FRAME_COUNT;
- v_fifo_index_u16 = v_fifo_index_u16
- + BMI160_FIFO_M_LENGTH;
- v_mag_index_u8++;
- }
- /* condition for FIFO over read enable*/
- if (v_fifo_data_u8[v_fifo_index_u16] == FIFO_CONFIG_CHECK1 &&
- v_fifo_data_u8[v_fifo_index_u16 + BMI160_FIFO_INDEX_LENGTH] ==
- FIFO_CONFIG_CHECK2) {
- break;
- }
- }
- return com_rslt;
- }
- #endif
- /*!
- * @brief This function is used to read the compensated value of mag
- * Before start reading the mag compensated 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.
- *
- * @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 to 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);
- if (com_rslt != 0)
- return com_rslt;
- /* 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 is used to get the compensated BMM150-X axis data
- *
- * 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 compensated X axis data
- *
- */
- s32 bmi160_bmm150_mag_compensate_X(s16 v_mag_data_x_s16, u16 v_data_r_u16)
- {
- s32 inter_retval = BMI160_INIT_VALUE;
- /* no overflow */
- if (v_mag_data_x_s16 != BMI160_MAG_FLIP_OVERFLOW_ADCVAL) {
- if ((v_data_r_u16 != 0)
- || (mag_trim.dig_xyz1 != 0)) {
- inter_retval = ((s32)(((u16)
- ((((s32)mag_trim.dig_xyz1)
- << BMI160_SHIFT_BIT_POSITION_BY_14_BITS)/
- (v_data_r_u16 != 0 ?
- v_data_r_u16 : mag_trim.dig_xyz1))) -
- ((u16)0x4000)));
- } 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_BIT_POSITION_BY_07_BITS)) +
- (((s32)inter_retval) *
- ((s32)(((s16)mag_trim.dig_xy1)
- << BMI160_SHIFT_BIT_POSITION_BY_07_BITS))))
- >> BMI160_SHIFT_BIT_POSITION_BY_09_BITS) +
- ((s32)0x100000)) *
- ((s32)(((s16)mag_trim.dig_x2) +
- ((s16)0xA0))))
- >> BMI160_SHIFT_BIT_POSITION_BY_12_BITS))
- >> BMI160_SHIFT_BIT_POSITION_BY_13_BITS)) +
- (((s16)mag_trim.dig_x1)
- << BMI160_SHIFT_BIT_POSITION_BY_03_BITS);
- /* 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 is used to get the compensated BMM150-Y axis data
- *
- * Before reading the Mag compensated Y axis 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 then 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 axis data
- * @param v_data_r_u16 : The value of Mag R data
- *
- * @return results of compensated Y axis data
- */
- s32 bmi160_bmm150_mag_compensate_Y(s16 v_mag_data_y_s16, u16 v_data_r_u16)
- {
- s32 inter_retval = BMI160_INIT_VALUE;
- /* no overflow */
- if (v_mag_data_y_s16 != BMI160_MAG_FLIP_OVERFLOW_ADCVAL) {
- if ((v_data_r_u16 != 0)
- || (mag_trim.dig_xyz1 != 0)) {
- inter_retval = ((s32)(((u16)(((
- (s32)mag_trim.dig_xyz1)
- << BMI160_SHIFT_BIT_POSITION_BY_14_BITS) /
- (v_data_r_u16 != 0 ?
- v_data_r_u16 : mag_trim.dig_xyz1))) -
- ((u16)0x4000)));
- } 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_BIT_POSITION_BY_07_BITS))
- + (((s32)inter_retval) *
- ((s32)(((s16)mag_trim.dig_xy1)
- << BMI160_SHIFT_BIT_POSITION_BY_07_BITS))))
- >> BMI160_SHIFT_BIT_POSITION_BY_09_BITS) +
- ((s32)0x100000))
- * ((s32)(((s16)mag_trim.dig_y2)
- + ((s16)0xA0))))
- >> BMI160_SHIFT_BIT_POSITION_BY_12_BITS))
- >> BMI160_SHIFT_BIT_POSITION_BY_13_BITS)) +
- (((s16)mag_trim.dig_y1)
- << BMI160_SHIFT_BIT_POSITION_BY_03_BITS);
- /* 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 is used to get the compensated BMM150-Z axis data
- *
- * Before 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 then 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 axis data
- */
- s32 bmi160_bmm150_mag_compensate_Z(s16 v_mag_data_z_s16, u16 v_data_r_u16)
- {
- s32 retval = BMI160_INIT_VALUE;
- if (v_mag_data_z_s16 != BMI160_MAG_HALL_OVERFLOW_ADCVAL) {
- if ((v_data_r_u16 != 0)
- && (mag_trim.dig_z2 != 0)
- && (mag_trim.dig_z1 != 0)) {
- retval = (((((s32)(v_mag_data_z_s16 - mag_trim.dig_z4))
- << BMI160_SHIFT_BIT_POSITION_BY_15_BITS) -
- ((((s32)mag_trim.dig_z3) *
- ((s32)(((s16)v_data_r_u16) -
- ((s16)mag_trim.dig_xyz1))))
- >> BMI160_SHIFT_BIT_POSITION_BY_02_BITS))/
- (mag_trim.dig_z2 +
- ((s16)(((((s32)mag_trim.dig_z1) *
- ((((s16)v_data_r_u16)
- << BMI160_SHIFT_BIT_POSITION_BY_01_BIT))) +
- (1 << BMI160_SHIFT_BIT_POSITION_BY_15_BITS))
- >> BMI160_SHIFT_BIT_POSITION_BY_16_BITS))));
- }
- } else {
- retval = BMI160_MAG_OVERFLOW_OUTPUT;
- }
- return retval;
- }
- /*!
- * @brief This function is used to 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(u8 *v_chip_id_u8)
- {
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = BMI160_INIT_VALUE;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 v_accel_power_mode_status = BMI160_INIT_VALUE;
- com_rslt = bmi160_get_accel_power_mode_stat(
- &v_accel_power_mode_status);
- /* Accel operation mode to normal*/
- if (v_accel_power_mode_status != BMI160_ACCEL_NORMAL_MODE) {
- com_rslt += bmi160_set_command_register(ACCEL_MODE_NORMAL);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- /* write the Mag power mode as NORMAL*/
- com_rslt += bmi160_set_mag_interface_normal();
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* Write the BMM150 i2c address*/
- com_rslt += bmi160_set_i2c_device_addr(BMI160_AUX_BMM150_I2C_ADDRESS);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* enable the Mag interface to manual mode*/
- com_rslt += bmi160_set_mag_manual_enable(BMI160_MANUAL_ENABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- bmi160_get_mag_manual_enable(&v_data_u8);
- /*Enable the MAG interface */
- com_rslt += bmi160_set_if_mode(BMI160_ENABLE_MAG_IF_MODE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- bmi160_get_if_mode(&v_data_u8);
- /* Mag normal mode*/
- com_rslt += bmi160_bmm150_mag_wakeup();
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* Read the BMM150 device id is 0x32*/
- com_rslt += bmi160_set_mag_read_addr(BMI160_BMM150_CHIP_ID);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- *v_chip_id_u8 = v_data_u8;
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* write the power mode register*/
- com_rslt += bmi160_set_mag_write_data(BMI160_BMM_POWER_MODE_REG);
- /*write 0x4C register to write set power mode to normal*/
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWER_MODE_REG);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* read the Mag trim values*/
- com_rslt += bmi160_read_bmm150_mag_trim();
- /* To avoid the auto mode enable when manual mode operation running*/
- bmm150_manual_auto_condition_u8_g = BMI160_MANUAL_ENABLE;
- /* 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*/
- bmm150_manual_auto_condition_u8_g = BMI160_MANUAL_DISABLE;
- /* Set the power mode of Mag as force mode*/
- com_rslt += bmi160_set_mag_write_data(BMI160_BMM150_FORCE_MODE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* write into power mode register*/
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWER_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(BMI160_GEN_READ_WRITE_DELAY);
- /* When Mag interface is in auto mode - The Mag read address
- starts at the register 0x42*/
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_BMM150_DATA_REG);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* enable Mag interface to auto mode*/
- com_rslt += bmi160_set_mag_manual_enable(BMI160_MANUAL_DISABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- bmi160_get_mag_manual_enable(&v_data_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- switch (v_accel_power_mode_status) {
- case BMI160_ACCEL_SUSPEND:
- com_rslt += bmi160_set_command_register(ACCEL_SUSPEND);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_ACCEL_LOW_POWER:
- com_rslt += bmi160_set_command_register(ACCEL_LOWPOWER);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- default:
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This function is used to 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 to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = BMI160_INIT_VALUE;
- u8 v_try_times_u8 = BMI160_BMM150_MAX_RETRY_WAKEUP;
- u8 v_power_control_bit_u8 = BMI160_INIT_VALUE;
- u8 i = BMI160_INIT_VALUE;
- for (i = BMI160_INIT_VALUE; i < v_try_times_u8; i++) {
- com_rslt = bmi160_set_mag_write_data(BMI160_BMM150_POWER_ON);
- p_bmi160->delay_msec(BMI160_BMM150_WAKEUP_DELAY1);
- /*write 0x4B register to enable power control bit*/
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWER_CONTROL_REG);
- p_bmi160->delay_msec(BMI160_BMM150_WAKEUP_DELAY2);
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_BMM150_POWER_CONTROL_REG);
- /* 0x04 is secondary read Mag x LSB register */
- p_bmi160->delay_msec(BMI160_BMM150_WAKEUP_DELAY3);
- com_rslt += bmi160_read_reg(BMI160_USER_DATA_0_ADDR,
- &v_power_control_bit_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- v_power_control_bit_u8 = BMI160_BMM150_SET_POWER_CONTROL
- & v_power_control_bit_u8;
- if (v_power_control_bit_u8 == BMI160_BMM150_POWER_ON)
- break;
- }
- com_rslt = (i >= v_try_times_u8) ?
- BMI160_BMM150_POWER_ON_FAIL : BMI160_BMM150_POWER_ON_SUCCESS;
- return com_rslt;
- }
- /*!
- * @brief This function is used to set the Mag
- * power mode.
- * @note Before setting the Mag power mode
- * make sure the following points are 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)
- {
- u8 v_accel_power_mode_status = BMI160_INIT_VALUE;
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = BMI160_INIT_VALUE;
- com_rslt = bmi160_get_accel_power_mode_stat(
- &v_accel_power_mode_status);
- /* set the Accel power mode to NORMAL*/
- if (v_accel_power_mode_status != BMI160_ACCEL_NORMAL_MODE) {
- com_rslt += bmi160_set_command_register(ACCEL_MODE_NORMAL);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- switch (v_mag_sec_if_pow_mode_u8) {
- case BMI160_MAG_FORCE_MODE:
- /* set the secondary Mag power mode as NORMAL*/
- com_rslt += bmi160_set_mag_interface_normal();
- /* set the Mag power mode as FORCE mode*/
- com_rslt += bmi160_bmm150_mag_set_power_mode(FORCE_MODE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_MAG_SUSPEND_MODE:
- /* set the Mag power mode as SUSPEND mode*/
- com_rslt += bmi160_bmm150_mag_set_power_mode(SUSPEND_MODE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* set the secondary Mag power mode as SUSPEND*/
- com_rslt += bmi160_set_command_register(MAG_MODE_SUSPEND);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- if (p_bmi160->mag_manual_enable == BMI160_MANUAL_ENABLE) {
- /* set Mag interface auto mode*/
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_MANUAL_DISABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- switch (v_accel_power_mode_status) {
- case BMI160_ACCEL_SUSPEND:
- com_rslt += bmi160_set_command_register(ACCEL_SUSPEND);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_ACCEL_LOW_POWER:
- com_rslt += bmi160_set_command_register(ACCEL_LOWPOWER);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- default:
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This function is used to set the Mag
- * power mode.
- * @note
- * Before setting 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 then 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 to 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_MANUAL_ENABLE) {
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_MANUAL_ENABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- if (com_rslt != SUCCESS)
- return com_rslt;
- } else {
- com_rslt = SUCCESS;
- }
- switch (v_mag_pow_mode_u8) {
- case FORCE_MODE:
- /* 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(
- BMI160_BMM150_FORCE_MODE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWER_MODE_REG);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* To avoid the auto mode enable when manual
- mode operation running*/
- bmm150_manual_auto_condition_u8_g = BMI160_MANUAL_ENABLE;
- /* set the preset mode */
- com_rslt += bmi160_set_bmm150_mag_presetmode(
- BMI160_MAG_PRESETMODE_REGULAR);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* To avoid the auto mode enable when manual
- mode operation running*/
- bmm150_manual_auto_condition_u8_g = BMI160_MANUAL_DISABLE;
- /* set the Mag read address to data registers*/
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_BMM150_DATA_REG);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case SUSPEND_MODE:
- /* Set the power mode of Mag as suspend mode*/
- com_rslt = bmi160_set_mag_write_data(
- BMI160_BMM150_POWER_OFF);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWER_CONTROL_REG);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /* set Mag interface auto mode*/
- if (p_bmi160->mag_manual_enable == BMI160_MANUAL_ENABLE) {
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_MANUAL_DISABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This API is used to set the pre-set modes of bmm150
- * The pre-set mode setting depends on the data rate and xy and z
- * repetitions
- *
- * @note
- * Before setting 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 to 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_MANUAL_ENABLE)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_MANUAL_ENABLE);
- switch (v_mode_u8) {
- case BMI160_MAG_PRESETMODE_LOWPOWER:
- /* write the XY and Z repetitions*/
- com_rslt = bmi160_set_mag_write_data(
- BMI160_MAG_LOWPOWER_REPXY);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_XY_REP);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* write the Z repetitions*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_MAG_LOWPOWER_REPZ);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_Z_REP);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 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(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWER_MODE_REG);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_MAG_PRESETMODE_REGULAR:
- /* write the XY and Z repetitions*/
- com_rslt = bmi160_set_mag_write_data(
- BMI160_MAG_REGULAR_REPXY);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_XY_REP);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* write the Z repetitions*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_MAG_REGULAR_REPZ);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_Z_REP);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 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(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWER_MODE_REG);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_MAG_PRESETMODE_HIGHACCURACY:
- /* write the XY and Z repetitions*/
- com_rslt = bmi160_set_mag_write_data(
- BMI160_MAG_HIGHACCURACY_REPXY);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_XY_REP);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* write the Z repetitions*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_MAG_HIGHACCURACY_REPZ);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_Z_REP);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 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(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWER_MODE_REG);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_MAG_PRESETMODE_ENHANCED:
- /* write the XY and Z repetitions*/
- com_rslt = bmi160_set_mag_write_data(
- BMI160_MAG_ENHANCED_REPXY);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_XY_REP);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* write the Z repetitions*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_MAG_ENHANCED_REPZ);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_Z_REP);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 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(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWER_MODE_REG);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- if (bmm150_manual_auto_condition_u8_g == BMI160_MANUAL_DISABLE) {
- com_rslt += bmi160_set_mag_write_data(
- BMI160_BMM150_FORCE_MODE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_BMM150_POWER_MODE_REG);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_read_addr(BMI160_BMM150_DATA_REG);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* set Mag interface auto mode*/
- if (p_bmi160->mag_manual_enable == BMI160_MANUAL_ENABLE)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_MANUAL_DISABLE);
- }
- return com_rslt;
- }
- /*!
- * @brief This function is used to read the trim values of Mag
- *
- * @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)
- {
- /* variable used to 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[BMI160_MAG_TRIM_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE};
- /* read dig_x1 value */
- com_rslt = bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_X1);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_X1],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- mag_trim.dig_x1 = v_data_u8[BMI160_BMM150_DIG_X1];
- /* read dig_y1 value */
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_Y1);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_Y1],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- mag_trim.dig_y1 = v_data_u8[BMI160_BMM150_DIG_Y1];
- /* read dig_x2 value */
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_X2);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_X2],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- mag_trim.dig_x2 = v_data_u8[BMI160_BMM150_DIG_X2];
- /* read dig_y2 value */
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_Y2);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_Y3],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- mag_trim.dig_y2 = v_data_u8[BMI160_BMM150_DIG_Y3];
- /* read dig_xy1 value */
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_XY1);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_XY1],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- mag_trim.dig_xy1 = v_data_u8[BMI160_BMM150_DIG_XY1];
- /* read dig_xy2 value */
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_XY2);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is v_mag_x_s16 ls register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_XY2],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- mag_trim.dig_xy2 = v_data_u8[BMI160_BMM150_DIG_XY2];
- /* read dig_z1 LSB value */
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_MAG_DIG_Z1_LSB);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_Z1_LSB],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* read dig_z1 MSB value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_Z1_MSB);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is v_mag_x_s16 MSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_Z1_MSB],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- mag_trim.dig_z1 =
- (u16)((((u32)((u8)v_data_u8[BMI160_BMM150_DIG_Z1_MSB]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) |
- (v_data_u8[BMI160_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(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_Z2_LSB],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* read dig_z2 MSB value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_Z2_MSB);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is v_mag_x_s16 MSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_Z2_MSB],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- mag_trim.dig_z2 =
- (s16)((((s32)((s8)v_data_u8[BMI160_BMM150_DIG_Z2_MSB]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) |
- (v_data_u8[BMI160_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(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_DIG_Z3_LSB],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* read dig_z3 MSB value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_Z3_MSB);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is v_mag_x_s16 MSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_DIG_Z3_MSB],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- mag_trim.dig_z3 =
- (s16)((((s32)((s8)v_data_u8[BMI160_BMM150_DIG_DIG_Z3_MSB]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) |
- (v_data_u8[BMI160_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(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_DIG_Z4_LSB],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* read dig_z4 MSB value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_Z4_MSB);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is v_mag_x_s16 MSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_DIG_Z4_MSB],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- mag_trim.dig_z4 =
- (s16)((((s32)((s8)v_data_u8[BMI160_BMM150_DIG_DIG_Z4_MSB]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) |
- (v_data_u8[BMI160_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(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_DIG_XYZ1_LSB],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* read dig_xyz1 MSB value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_MAG_DIG_XYZ1_MSB);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is v_mag_x_s16 MSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[BMI160_BMM150_DIG_DIG_XYZ1_MSB],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- mag_trim.dig_xyz1 =
- (u16)((((u32)((u8)v_data_u8[BMI160_BMM150_DIG_DIG_XYZ1_MSB]))
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) |
- (v_data_u8[BMI160_BMM150_DIG_DIG_XYZ1_LSB]));
- return com_rslt;
- }
- #ifdef AKM09912
- /***************************************************/
- /**\name FUNCTIONS FOR AKM09912*/
- /***************************************************/
- /*!
- * @brief This API is used to get the compensated X data
- * of AKM09912 sensor
- * Output of X is s32
- * @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 compensated X data value
- *
- */
- s32 bmi160_bst_akm09912_compensate_X(s16 v_bst_akm_x_s16)
- {
- /*Return value of AKM x compensated data*/
- s32 retval = BMI160_INIT_VALUE;
- /* Convert raw data into compensated data*/
- retval = v_bst_akm_x_s16 *
- (akm_asa_data.asax + AKM09912_SENSITIVITY)
- / AKM09912_SENSITIVITY_DIV;
- return retval;
- }
- /*!
- * @brief This API is used to get the compensated Y data
- * of AKM09912 sensor
- * @note Before 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 compensated Y data value
- *
- */
- s32 bmi160_bst_akm09912_compensate_Y(s16 v_bst_akm_y_s16)
- {
- /*Return value of AKM y compensated data*/
- s32 retval = BMI160_INIT_VALUE;
- /* Convert raw data into compensated data*/
- retval = v_bst_akm_y_s16 *
- (akm_asa_data.asax + AKM09912_SENSITIVITY)
- / AKM09912_SENSITIVITY_DIV;
- return retval;
- }
- /*!
- * @brief This API is used to get the compensated Z data
- * of AKM09912
- * Output of X is s32
- * @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 compensated Z data value
- *
- */
- s32 bmi160_bst_akm09912_compensate_Z(s16 v_bst_akm_z_s16)
- {
- /*Return value of AKM z compensated data*/
- s32 retval = BMI160_INIT_VALUE;
- /* Convert raw data into compensated data*/
- retval = v_bst_akm_z_s16 *
- (akm_asa_data.asax + AKM09912_SENSITIVITY)
- / AKM09912_SENSITIVITY_DIV;
- return retval;
- }
- /*!
- * @brief This function is used to read the compensated value of
- * AKM09912 sensor
- * @note 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_bst_akm09912_compensate_xyz(
- struct bmi160_bst_akm_xyz_t *bst_akm_xyz)
- {
- /* variable used to 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, BST_AKM);
- /* Compensation for X axis */
- bst_akm_xyz->x = bmi160_bst_akm09912_compensate_X(mag_xyz.x);
- /* Compensation for Y axis */
- bst_akm_xyz->y = bmi160_bst_akm09912_compensate_Y(mag_xyz.y);
- /* Compensation for Z axis */
- bst_akm_xyz->z = bmi160_bst_akm09912_compensate_Z(mag_xyz.z);
- return com_rslt;
- }
- #endif
- #ifdef AKM09911
- /***************************************************/
- /**\name FUNCTIONS FOR AKM09911 */
- /***************************************************/
- /*!
- * @brief This API is used to get the compensated X data
- * of AKM09911 sensor
- * Output of X is s32
- * @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 compensated X data value
- *
- */
- s32 bmi160_bst_akm09911_compensate_X(s16 v_bst_akm_x_s16)
- {
- /*Return value of AKM x compensated v_data_u8*/
- s32 retval = BMI160_INIT_VALUE;
- /* Convert raw v_data_u8 into compensated v_data_u8*/
- retval = (v_bst_akm_x_s16 *
- ((akm_asa_data.asax/AKM09911_SENSITIVITY_DIV) +
- BMI160_GEN_READ_WRITE_DATA_LENGTH));
- return retval;
- }
- /*!
- * @brief This API is used to get the compensated Y data
- * of AKM09911 sensor
- * Output of Y is s32
- * @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 compensated Y data value
- *
- */
- s32 bmi160_bst_akm09911_compensate_Y(s16 v_bst_akm_y_s16)
- {
- /*Return value of AKM y compensated v_data_u8*/
- s32 retval = BMI160_INIT_VALUE;
- /* Convert raw v_data_u8 into compensated v_data_u8*/
- retval = (v_bst_akm_y_s16 *
- ((akm_asa_data.asay/AKM09911_SENSITIVITY_DIV) +
- BMI160_GEN_READ_WRITE_DATA_LENGTH));
- return retval;
- }
- /*!
- * @brief This API is used to get the compensated Z data
- * of AKM09911 sensor
- * Out put of Z is s32
- * @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 compensated Z data value
- *
- */
- s32 bmi160_bst_akm09911_compensate_Z(s16 v_bst_akm_z_s16)
- {
- /*Return value of AKM z compensated v_data_u8*/
- s32 retval = BMI160_INIT_VALUE;
- /* Convert raw v_data_u8 into compensated v_data_u8*/
- retval = (v_bst_akm_z_s16 *
- ((akm_asa_data.asaz/AKM09911_SENSITIVITY_DIV) +
- BMI160_GEN_READ_WRITE_DATA_LENGTH));
- return retval;
- }
- /*!
- * @brief This function is used to read the compensated value of
- * AKM09911
- * @note 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_bst_akm09911_compensate_xyz(
- struct bmi160_bst_akm_xyz_t *bst_akm_xyz)
- {
- /* variable used to 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, BST_AKM);
- /* Compensation for X axis */
- bst_akm_xyz->x = bmi160_bst_akm09911_compensate_X(mag_xyz.x);
- /* Compensation for Y axis */
- bst_akm_xyz->y = bmi160_bst_akm09911_compensate_Y(mag_xyz.y);
- /* Compensation for Z axis */
- bst_akm_xyz->z = bmi160_bst_akm09911_compensate_Z(mag_xyz.z);
- return com_rslt;
- }
- #endif
- #if defined AKM09911 || defined AKM09912
- /***************************************************/
- /**\name FUNCTIONS FOR AKM09911 and AKM09912 */
- /***************************************************/
- /*!
- * @brief This function is used to initialize
- * the AKM09911 and AKM09912 sensor
- *
- *
- * @param v_akm_i2c_address_u8: The value of device address
- * AKM sensor | Slave address
- * --------------|---------------------
- * AKM09911 | AKM09911_I2C_ADDR_1
- * - | and AKM09911_I2C_ADDR_2
- * AKM09912 | AKM09912_I2C_ADDR_1
- * - | AKM09912_I2C_ADDR_2
- * - | AKM09912_I2C_ADDR_3
- * - | AKM09912_I2C_ADDR_4
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_akm_mag_interface_init(
- u8 v_akm_i2c_address_u8)
- {
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 v_akm_chip_id_u8 = BMI160_INIT_VALUE;
- u8 v_accel_power_mode_status = BMI160_INIT_VALUE;
- com_rslt = bmi160_get_accel_power_mode_stat(
- &v_accel_power_mode_status);
- /* set Accel operation mode to normal*/
- if (v_accel_power_mode_status != BMI160_ACCEL_NORMAL_MODE) {
- com_rslt += bmi160_set_command_register(ACCEL_MODE_NORMAL);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- com_rslt += bmi160_set_command_register(MAG_MODE_NORMAL);
- p_bmi160->delay_msec(BMI160_AKM_INIT_DELAY);
- bmi160_get_mag_power_mode_stat(&v_data_u8);
- /* Write the AKM09911 0r AKM09912 i2c address*/
- com_rslt += bmi160_set_i2c_device_addr(v_akm_i2c_address_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* enable the Mag interface to manual mode*/
- com_rslt += bmi160_set_mag_manual_enable(BMI160_MANUAL_ENABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- bmi160_get_mag_manual_enable(&v_data_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /*Enable the MAG interface */
- com_rslt += bmi160_set_if_mode(BMI160_ENABLE_MAG_IF_MODE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- bmi160_get_if_mode(&v_data_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* Set the AKM Fuse ROM mode */
- com_rslt += bmi160_set_mag_write_data(AKM_FUSE_ROM_MODE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* AKM mode address is 0x31*/
- com_rslt += bmi160_set_mag_write_addr(AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* 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(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* read the device id of the AKM sensor
- if device id is 0x05 - AKM09911
- if device id is 0x04 - AKM09912*/
- com_rslt += bmi160_set_mag_read_addr(AKM_CHIP_ID_REG);
- /* 0x04 is mag_x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_akm_chip_id_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Set power down mode*/
- com_rslt += bmi160_set_mag_write_data(AKM_POWER_DOWN_MODE_DATA);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* AKM mode address is 0x31*/
- com_rslt += bmi160_set_mag_write_addr(AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* Set AKM Force mode*/
- com_rslt += bmi160_set_mag_write_data(
- AKM_SINGLE_MEASUREMENT_MODE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* AKM mode address is 0x31*/
- com_rslt += bmi160_set_mag_write_addr(AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* 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(BMI160_GEN_READ_WRITE_DELAY);
- /* Enable Mag interface to auto mode*/
- com_rslt += bmi160_set_mag_manual_enable(BMI160_MANUAL_DISABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- bmi160_get_mag_manual_enable(&v_data_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- switch (v_accel_power_mode_status) {
- case BMI160_ACCEL_SUSPEND:
- com_rslt += bmi160_set_command_register(ACCEL_SUSPEND);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_ACCEL_LOW_POWER:
- com_rslt += bmi160_set_command_register(ACCEL_LOWPOWER);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- default:
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This function is used to read the sensitivity data of
- * AKM09911 and AKM09912
- *
- * @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 is used to 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[BMI160_AKM_SENSITIVITY_DATA_SIZE] = {
- BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* read asax value */
- com_rslt = bmi160_set_mag_read_addr(BMI160_BST_AKM_ASAX);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[AKM_ASAX],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- 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(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[AKM_ASAY],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- 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(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[AKM_ASAZ],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- akm_asa_data.asaz = v_data_u8[AKM_ASAZ];
- return com_rslt;
- }
- /*!
- * @brief This function is used to set the AKM09911 and AKM09912
- * power mode.
- * @note Before setting 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 then 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 is used to 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_MANUAL_ENABLE) {
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_MANUAL_ENABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- switch (v_akm_pow_mode_u8) {
- case AKM_POWER_DOWN_MODE:
- /* 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(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- break;
- case AKM_SINGLE_MEAS_MODE:
- /* 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(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_read_addr(AKM_DATA_REGISTER);
- break;
- case FUSE_ROM_MODE:
- /* 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(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* Sensitivity v_data_u8 */
- com_rslt += bmi160_read_bst_akm_sensitivity_data();
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* power down mode*/
- com_rslt += bmi160_set_mag_write_data(
- AKM_POWER_DOWN_MODE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- AKM_POWER_MODE_REG);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /* set Mag interface auto mode*/
- if (p_bmi160->mag_manual_enable == BMI160_MANUAL_ENABLE) {
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_MANUAL_DISABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This function is used to set the Mag
- * power mode of AKM09911 and AKM09912
- * @note Before setting the Mag power mode
- * make sure the following two points are addressed
- * Make sure the Mag interface is enabled or not,
- * by using the bmi160_get_if_mode() function.
- * If Mag interface is not enabled then 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)
- {
- u8 v_accel_power_mode_status = BMI160_INIT_VALUE;
- /* variable used to return the status of communication result*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- com_rslt = bmi160_get_accel_power_mode_stat(
- &v_accel_power_mode_status);
- /* Accel operation mode to normal*/
- if (v_accel_power_mode_status != BMI160_ACCEL_NORMAL_MODE) {
- com_rslt += bmi160_set_command_register(ACCEL_MODE_NORMAL);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- /* set Mag interface manual mode*/
- if (p_bmi160->mag_manual_enable != BMI160_MANUAL_ENABLE) {
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_MANUAL_ENABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- switch (v_mag_sec_if_pow_mode_u8) {
- case BMI160_MAG_FORCE_MODE:
- /* set the secondary Mag power mode as NORMAL*/
- com_rslt += bmi160_set_mag_interface_normal();
- /* set the akm power mode as single measurement mode*/
- com_rslt += bmi160_bst_akm_set_powermode(
- AKM_SINGLE_MEAS_MODE);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_read_addr(AKM_DATA_REGISTER);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_MAG_SUSPEND_MODE:
- /* set the akm power mode as power down mode*/
- com_rslt += bmi160_bst_akm_set_powermode(
- AKM_POWER_DOWN_MODE);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* set the secondary Mag power mode as SUSPEND*/
- com_rslt += bmi160_set_command_register(
- MAG_MODE_SUSPEND);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- break;
- default:
- com_rslt = E_BMI160_OUT_OF_RANGE;
- break;
- }
- /* set Mag interface auto mode*/
- if (p_bmi160->mag_manual_enable == BMI160_MANUAL_ENABLE)
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_MANUAL_DISABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- switch (v_accel_power_mode_status) {
- case BMI160_ACCEL_SUSPEND:
- com_rslt += bmi160_set_command_register(ACCEL_SUSPEND);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_ACCEL_LOW_POWER:
- com_rslt += bmi160_set_command_register(ACCEL_LOWPOWER);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- default:
- break;
- }
- return com_rslt;
- }
- #endif
- #ifdef YAS532
- /***************************************************/
- /**\name FUNCTIONS FOR YAMAHA-YAS532 */
- /***************************************************/
- /*!
- * @brief This function is used to initialize the YAMAHA-YAS532 sensor
- *
- *
- * @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 to provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 i = BMI160_INIT_VALUE;
- u8 v_accel_power_mode_status = BMI160_INIT_VALUE;
- com_rslt = bmi160_get_accel_power_mode_stat(
- &v_accel_power_mode_status);
- /* Accel operation mode to normal*/
- if (v_accel_power_mode_status != BMI160_ACCEL_NORMAL_MODE) {
- com_rslt += bmi160_set_command_register(ACCEL_MODE_NORMAL);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- /* write Mag power mode as NORMAL*/
- com_rslt += bmi160_set_mag_interface_normal();
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* Write the YAS532 i2c address*/
- com_rslt += bmi160_set_i2c_device_addr(BMI160_AUX_YAS532_I2C_ADDRESS);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* enable the Mag interface to manual mode*/
- com_rslt += bmi160_set_mag_manual_enable(BMI160_MANUAL_ENABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- bmi160_get_mag_manual_enable(&v_data_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /*Enable the MAG interface */
- com_rslt += bmi160_set_if_mode(BMI160_ENABLE_MAG_IF_MODE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- bmi160_get_if_mode(&v_data_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- v_data_u8 = BMI160_MANUAL_DISABLE;
- /* Read the YAS532 device id is 0x02*/
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS_DEVICE_ID_REG);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* Read the YAS532 calibration data*/
- com_rslt += bmi160_bst_yamaha_yas532_calib_values();
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* 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 = 0;
- #if 1 < YAS532_MAG_TEMPERATURE_LOG
- yas532_data.temp_data.num =
- yas532_data.temp_data.idx = 0;
- #endif
- /* Assign the coefficient value*/
- for (i = 0; i < 3; i++) {
- yas532_data.coef[i] = yas532_version_ac_coef[i];
- yas532_data.last_raw[i] = 0;
- }
- yas532_data.last_raw[3] = 0;
- /* 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(BMI160_GEN_READ_WRITE_DELAY);
- /* Enable Mag interface to auto mode*/
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_MANUAL_DISABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- bmi160_get_mag_manual_enable(&v_data_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- switch (v_accel_power_mode_status) {
- case BMI160_ACCEL_SUSPEND:
- com_rslt += bmi160_set_command_register(ACCEL_SUSPEND);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_ACCEL_LOW_POWER:
- com_rslt += bmi160_set_command_register(ACCEL_LOWPOWER);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- default:
- break;
- }
- 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 is used to 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_TESTR1);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_TESTR1);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* write testr2 as 0x00*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_YAS532_WRITE_TESTR2);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_TESTR2);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* write Rcoil as 0x00*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_YAS532_WRITE_RCOIL);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_RCOIL);
- p_bmi160->delay_msec(BMI160_YAS532_SET_INITIAL_VALUE_DELAY);
- /* 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 is used to perform 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 to provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* to set the offset register*/
- s8 v_hard_offset_s8[BMI160_HARD_OFFSET_DATA_SIZE] = {
- BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* offset correction factors*/
- static const u8 v_correct_u8[BMI160_YAS_CORRECT_DATA_SIZE] = {
- 16, 8, 4, 2, 1};
- /* used to store the temperature */
- u16 v_temp_u16 = BMI160_INIT_VALUE;
- /* used to read for the xy1y2 value */
- u16 v_xy1y2_u16[BMI160_YAS_XY1Y2_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* local flag for assigning the values*/
- s32 v_flag_s32[BMI160_YAS_FLAG_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- u8 i, j, v_busy_u8, v_overflow_u8 = BMI160_INIT_VALUE;
- for (i = 0; i < 5; 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_YAS532_ACQ_START, &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 = 0; j < 3; j++) {
- if (YAS532_DATA_CENTER == v_xy1y2_u16[j])
- v_flag_s32[j] = 0;
- if (YAS532_DATA_CENTER < v_xy1y2_u16[j])
- v_flag_s32[j] = 1;
- if (v_xy1y2_u16[j] < YAS532_DATA_CENTER)
- v_flag_s32[j] = -1;
- }
- for (j = 0; j < 3; 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 to 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 is used to provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array holding the YAS532 calibration values */
- u8 v_data_u8[BMI160_YAS532_CALIB_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* Read the DX value */
- com_rslt = bmi160_set_mag_read_addr(BMI160_YAS532_CALIB_CX);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[0], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- yas532_data.calib_yas532.cx = (s32)((v_data_u8[0]
- * 10) - 1280);
- /* 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_MAG_DATA_READ_REG,
- &v_data_u8[1], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- yas532_data.calib_yas532.cy1 =
- (s32)((v_data_u8[1] * 10) - 1280);
- /* 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_MAG_DATA_READ_REG,
- &v_data_u8[2], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- yas532_data.calib_yas532.cy2 =
- (s32)((v_data_u8[2] * 10) - 1280);
- /* 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_MAG_DATA_READ_REG,
- &v_data_u8[3], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- yas532_data.calib_yas532.a2 =
- (s32)(((v_data_u8[3] >>
- BMI160_SHIFT_BIT_POSITION_BY_02_BITS)
- & 0x03F) - 32);
- /* 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_MAG_DATA_READ_REG,
- &v_data_u8[4], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* calculate a3*/
- yas532_data.calib_yas532.a3 = (s32)((((v_data_u8[3] <<
- BMI160_SHIFT_BIT_POSITION_BY_02_BITS) & 0x0C) |
- ((v_data_u8[4]
- >> BMI160_SHIFT_BIT_POSITION_BY_06_BITS)
- & 0x03)) - 8);
- /* calculate a4*/
- yas532_data.calib_yas532.a4 = (s32)((v_data_u8[4]
- & 0x3F) - 32);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 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_MAG_DATA_READ_REG,
- &v_data_u8[5], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* calculate a5*/
- yas532_data.calib_yas532.a5 =
- (s32)(((v_data_u8[5]
- >> BMI160_SHIFT_BIT_POSITION_BY_02_BITS)
- & 0x3F) + 38);
- /* 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_MAG_DATA_READ_REG,
- &v_data_u8[6], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* calculate a6*/
- yas532_data.calib_yas532.a6 =
- (s32)((((v_data_u8[5]
- << BMI160_SHIFT_BIT_POSITION_BY_04_BITS)
- & 0x30) | ((v_data_u8[6] >>
- BMI160_SHIFT_BIT_POSITION_BY_04_BITS)
- & 0x0F)) - 32);
- /* 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_MAG_DATA_READ_REG,
- &v_data_u8[7], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* calculate a7*/
- yas532_data.calib_yas532.a7 = (s32)((((v_data_u8[6]
- << BMI160_SHIFT_BIT_POSITION_BY_03_BITS)
- & 0x78) |
- ((v_data_u8[7]
- >> BMI160_SHIFT_BIT_POSITION_BY_05_BITS) &
- 0x07)) - 64);
- /* Read the D8 and D9 value */
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB6);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[8], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* calculate a8*/
- yas532_data.calib_yas532.a8 = (s32)((((v_data_u8[7] <<
- BMI160_GEN_READ_WRITE_DATA_LENGTH) & 0x3E) |
- ((v_data_u8[8] >>
- BMI160_SHIFT_BIT_POSITION_BY_07_BITS) & 0x01)) -
- 32);
- /* 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_MAG_DATA_READ_REG,
- &v_data_u8[9], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* calculate a9*/
- yas532_data.calib_yas532.a9 = (s32)(((v_data_u8[8] <<
- BMI160_GEN_READ_WRITE_DATA_LENGTH) & 0xFE) |
- ((v_data_u8[9] >>
- BMI160_SHIFT_BIT_POSITION_BY_07_BITS) & 0x01));
- /* calculate k*/
- yas532_data.calib_yas532.k = (s32)((v_data_u8[9] >>
- BMI160_SHIFT_BIT_POSITION_BY_02_BITS) & 0x1F);
- /* 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_MAG_DATA_READ_REG,
- &v_data_u8[10],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the value from register 0x9B*/
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS532_CALIB9);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8[11],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* 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_MAG_DATA_READ_REG,
- &v_data_u8[12],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* 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_MAG_DATA_READ_REG,
- &v_data_u8[13],
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Calculate the fxy1y2 and rxy1y1*/
- yas532_data.calib_yas532.fxy1y2[0] =
- (u8)(((v_data_u8[10]
- & 0x01)
- << BMI160_SHIFT_BIT_POSITION_BY_01_BIT)
- | ((v_data_u8[11] >>
- BMI160_SHIFT_BIT_POSITION_BY_07_BITS) & 0x01));
- yas532_data.calib_yas532.rxy1y2[0] =
- ((s8)(((v_data_u8[10]
- >> BMI160_SHIFT_BIT_POSITION_BY_01_BIT) & 0x3F)
- << BMI160_SHIFT_BIT_POSITION_BY_02_BITS))
- >> BMI160_SHIFT_BIT_POSITION_BY_02_BITS;
- yas532_data.calib_yas532.fxy1y2[1] =
- (u8)(((v_data_u8[11] & 0x01)
- << BMI160_SHIFT_BIT_POSITION_BY_01_BIT)
- | ((v_data_u8[12] >>
- BMI160_SHIFT_BIT_POSITION_BY_07_BITS) & 0x01));
- yas532_data.calib_yas532.rxy1y2[1] =
- ((s8)(((v_data_u8[11]
- >> BMI160_SHIFT_BIT_POSITION_BY_01_BIT) & 0x3F)
- << BMI160_SHIFT_BIT_POSITION_BY_02_BITS))
- >> BMI160_SHIFT_BIT_POSITION_BY_02_BITS;
- yas532_data.calib_yas532.fxy1y2[2] =
- (u8)(((v_data_u8[12] & 0x01)
- << BMI160_SHIFT_BIT_POSITION_BY_01_BIT)
- | ((v_data_u8[13]
- >> BMI160_SHIFT_BIT_POSITION_BY_07_BITS) & 0x01));
- yas532_data.calib_yas532.rxy1y2[2] =
- ((s8)(((v_data_u8[12]
- >> BMI160_SHIFT_BIT_POSITION_BY_01_BIT) & 0x3F)
- << BMI160_SHIFT_BIT_POSITION_BY_02_BITS))
- >> BMI160_SHIFT_BIT_POSITION_BY_02_BITS;
- return com_rslt;
- }
- /*!
- * @brief This function is used to calculate the
- * linear data in YAS532 sensor.
- *
- *
- * @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 to provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = SUCCESS;
- static const u16 v_calib_data[] = {
- 3721, 3971, 4221, 4471};
- u8 i = BMI160_INIT_VALUE;
- for (i = 0; i < 3; 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 is used to 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 flag 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 is used to provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array holding the YAS532 xyy1 data*/
- u8 v_data_u8[BMI160_YAS_XY1Y2T_DATA_SIZE] = {
- BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- u8 i = BMI160_INIT_VALUE;
- /* check the p_bmi160 structure for NULL pointer assignment*/
- 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, BMI160_MAG_YAS_DATA_LENGTH);
- /* read the xyy1 data*/
- *v_busy_u8 =
- ((v_data_u8[0]
- >> BMI160_SHIFT_BIT_POSITION_BY_07_BITS) & 0x01);
- *v_temp_u16 =
- (u16)((((s32)v_data_u8[0]
- << BMI160_SHIFT_BIT_POSITION_BY_03_BITS)
- & 0x3F8) | ((v_data_u8[1]
- >> BMI160_SHIFT_BIT_POSITION_BY_05_BITS) & 0x07));
- v_xy1y2_u16[0] =
- (u16)((((s32)v_data_u8[2]
- << BMI160_SHIFT_BIT_POSITION_BY_06_BITS) & 0x1FC0)
- | ((v_data_u8[3] >>
- BMI160_SHIFT_BIT_POSITION_BY_02_BITS) & 0x3F));
- v_xy1y2_u16[1] =
- (u16)((((s32)v_data_u8[4]
- << BMI160_SHIFT_BIT_POSITION_BY_06_BITS)
- & 0x1FC0)
- | ((v_data_u8[5]
- >> BMI160_SHIFT_BIT_POSITION_BY_02_BITS) & 0x3F));
- v_xy1y2_u16[2] =
- (u16)((((s32)v_data_u8[6]
- << BMI160_SHIFT_BIT_POSITION_BY_06_BITS)
- & 0x1FC0)
- | ((v_data_u8[7]
- >> BMI160_SHIFT_BIT_POSITION_BY_02_BITS) & 0x3F));
- *v_overflow_u8 = 0;
- for (i = 0; i < 3; i++) {
- if (v_xy1y2_u16[i] == YAS532_DATA_OVERFLOW)
- *v_overflow_u8 |= (1 << (i * 2));
- if (v_xy1y2_u16[i] == YAS532_DATA_UNDERFLOW)
- *v_overflow_u8 |= (1 << (i * 2 + 1));
- }
- }
- return com_rslt;
- }
- /*!
- * @brief This function is used to read the 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 is used to 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[BMI160_YAS_XY1Y2_DATA_SIZE] = {
- BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* Array holding the temperature data */
- s32 v_xyz_tmp_s32[BMI160_YAS_TEMP_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- s32 tmp = BMI160_INIT_VALUE;
- s32 sx, sy1, sy2, sy, sz = BMI160_INIT_VALUE;
- u8 i, v_busy_u8 = BMI160_INIT_VALUE;
- u16 v_temp_u16 = BMI160_INIT_VALUE;
- /* Array holding the xyy1 sensor raw data*/
- u16 v_xy1y2_u16[BMI160_YAS_XY1Y2_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- #if 1 < YAS532_MAG_TEMPERATURE_LOG
- s32 sum = BMI160_INIT_VALUE;
- #endif
- *v_overflow_s8 = BMI160_INIT_VALUE;
- switch (yas532_data.measure_state) {
- case YAS532_MAG_STATE_INIT_COIL:
- if (p_bmi160->mag_manual_enable != BMI160_MANUAL_ENABLE)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_MANUAL_ENABLE);
- /* write Rcoil*/
- com_rslt += bmi160_set_mag_write_data(
- BMI160_YAS_DISABLE_RCOIL);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_RCOIL);
- p_bmi160->delay_msec(BMI160_YAS532_MEASUREMENT_DELAY);
- if (!yas532_data.overflow && is_valid_offset(
- yas532_data.v_hard_offset_s8))
- yas532_data.measure_state = 0;
- break;
- case YAS532_MAG_STATE_MEASURE_OFFSET:
- com_rslt = bmi160_bst_yas532_magnetic_measure_set_offset();
- yas532_data.measure_state = 0;
- 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 = 0;
- 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 = 0; i < yas532_data.temp_data.num; i++)
- sum += yas532_data.temp_data.log[i];
- tmp = sum * 10 / yas532_data.temp_data.num
- - YAS532_TEMP20DEGREE_TYPICAL * 10;
- #else
- tmp = (v_temp_u16 - YAS532_TEMP20DEGREE_TYPICAL)
- * 10;
- #endif
- sx = v_xy1y2_linear_s32[0];
- sy1 = v_xy1y2_linear_s32[1];
- sy2 = v_xy1y2_linear_s32[2];
- /* Temperature correction */
- if (v_temp_correction_u8) {
- sx -= (yas532_data.calib_yas532.cx * tmp)
- / 1000;
- sy1 -= (yas532_data.calib_yas532.cy1 * tmp)
- / 1000;
- sy2 -= (yas532_data.calib_yas532.cy2 * tmp)
- / 1000;
- }
- sy = sy1 - sy2;
- sz = -sy1 - sy2;
- #if 1
- xyz_data->yas532_vector_xyz[0] = yas532_data.calib_yas532.k *
- ((100 * sx + yas532_data.calib_yas532.a2 * sy +
- yas532_data.calib_yas532.a3 * sz) / 10);
- xyz_data->yas532_vector_xyz[1] = yas532_data.calib_yas532.k *
- ((yas532_data.calib_yas532.a4 * sx + yas532_data.calib_yas532.a5 * sy +
- yas532_data.calib_yas532.a6 * sz) / 10);
- xyz_data->yas532_vector_xyz[2] = yas532_data.calib_yas532.k *
- ((yas532_data.calib_yas532.a7 * sx + yas532_data.calib_yas532.a8 * sy +
- yas532_data.calib_yas532.a9 * sz) / 10);
- if (yas532_data.transform != BMI160_NULL) {
- for (i = 0; i < 3; i++) {
- v_xyz_tmp_s32[i] = yas532_data.transform[i
- * 3] *
- xyz_data->yas532_vector_xyz[0]
- + yas532_data.transform[i * 3 + 1] *
- xyz_data->yas532_vector_xyz[1]
- + yas532_data.transform[i * 3 + 2] *
- xyz_data->yas532_vector_xyz[2];
- }
- set_vector(xyz_data->yas532_vector_xyz, v_xyz_tmp_s32);
- }
- for (i = 0; i < 3; i++) {
- xyz_data->yas532_vector_xyz[i] -=
- xyz_data->yas532_vector_xyz[i] % 10;
- if (*v_overflow_s8 & (1
- << (i * 2)))
- xyz_data->yas532_vector_xyz[i] +=
- 1; /* set overflow */
- if (*v_overflow_s8 & (1 <<
- (i * 2 + 1)))
- xyz_data->yas532_vector_xyz[i] += 2; /* set underflow */
- }
- #else
- xyz_data->yas532_vector_xyz[0] = sx;
- xyz_data->yas532_vector_xyz[1] = sy;
- xyz_data->yas532_vector_xyz[2] = sz;
- #endif
- if (v_busy_u8)
- return com_rslt;
- if (0 < *v_overflow_s8) {
- if (!yas532_data.overflow)
- yas532_data.overflow = 1;
- yas532_data.measure_state = YAS532_MAG_STATE_INIT_COIL;
- } else
- yas532_data.overflow = 0;
- for (i = 0; i < 3; i++)
- yas532_data.last_raw[i] = v_xy1y2_u16[i];
- yas532_data.last_raw[i] = v_temp_u16;
- return com_rslt;
- }
- /*!
- * @brief This function is used to read YAS532 sensor data
- *
- *
- * @param v_xy1y2_u16 : the vector xyz output
- * @param v_overflow_s8 : the value of overflow
- * @param v_temp_correction_u8 : the value of temperate correction enable
- * @param v_temp_u16 : the value of temperature
- * @param v_busy_u8 : the value denoting the sensor is busy
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yas532_fifo_xyz_data(
- u16 *v_xy1y2_u16, u8 v_temp_correction_u8,
- s8 v_overflow_s8, u16 v_temp_u16, u8 v_busy_u8)
- {
- /* This variable is used to 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[BMI160_YAS_XY1Y2_DATA_SIZE] = {
- BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* Array holding the temperature data */
- s32 v_xyz_tmp_s32[BMI160_YAS_TEMP_DATA_SIZE] = {BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- s32 tmp = BMI160_INIT_VALUE;
- s32 sx, sy1, sy2, sy, sz = BMI160_INIT_VALUE;
- u8 i = BMI160_INIT_VALUE;
- #if 1 < YAS532_MAG_TEMPERATURE_LOG
- s32 sum = BMI160_INIT_VALUE;
- #endif
- v_overflow_s8 = BMI160_INIT_VALUE;
- /* 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 = 0;
- 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 = 0; i < yas532_data.temp_data.num; i++)
- sum += yas532_data.temp_data.log[i];
- tmp = sum * 10 / yas532_data.temp_data.num
- - YAS532_TEMP20DEGREE_TYPICAL * 10;
- #else
- tmp = (v_temp_u16 - YAS532_TEMP20DEGREE_TYPICAL)
- * 10;
- #endif
- sx = v_xy1y2_linear_s32[0];
- sy1 = v_xy1y2_linear_s32[1];
- sy2 = v_xy1y2_linear_s32[2];
- /* Temperature correction */
- if (v_temp_correction_u8) {
- sx -= (yas532_data.calib_yas532.cx * tmp)
- / 1000;
- sy1 -= (yas532_data.calib_yas532.cy1 * tmp)
- / 1000;
- sy2 -= (yas532_data.calib_yas532.cy2 * tmp)
- / 1000;
- }
- sy = sy1 - sy2;
- sz = -sy1 - sy2;
- #if 1
- fifo_xyz_data.yas532_vector_xyz[0] = yas532_data.calib_yas532.k *
- ((100 * sx + yas532_data.calib_yas532.a2 * sy +
- yas532_data.calib_yas532.a3 * sz) / 10);
- fifo_xyz_data.yas532_vector_xyz[1] = yas532_data.calib_yas532.k *
- ((yas532_data.calib_yas532.a4 * sx + yas532_data.calib_yas532.a5 * sy +
- yas532_data.calib_yas532.a6 * sz) / 10);
- fifo_xyz_data.yas532_vector_xyz[2] = yas532_data.calib_yas532.k *
- ((yas532_data.calib_yas532.a7 * sx + yas532_data.calib_yas532.a8 * sy +
- yas532_data.calib_yas532.a9 * sz) / 10);
- if (yas532_data.transform != BMI160_NULL) {
- for (i = 0; i < 3; i++) {
- v_xyz_tmp_s32[i] = yas532_data.transform[i
- * 3] *
- fifo_xyz_data.yas532_vector_xyz[0]
- + yas532_data.transform[i * 3 + 1] *
- fifo_xyz_data.yas532_vector_xyz[1]
- + yas532_data.transform[i * 3 + 2] *
- fifo_xyz_data.yas532_vector_xyz[2];
- }
- set_vector(fifo_xyz_data.yas532_vector_xyz, v_xyz_tmp_s32);
- }
- for (i = 0; i < 3; i++) {
- fifo_xyz_data.yas532_vector_xyz[i] -=
- fifo_xyz_data.yas532_vector_xyz[i] % 10;
- if (v_overflow_s8 & (1
- << (i * 2)))
- fifo_xyz_data.yas532_vector_xyz[i] +=
- 1; /* set overflow */
- if (v_overflow_s8 & (1 <<
- (i * 2 + 1)))
- fifo_xyz_data.yas532_vector_xyz[i] += 2;
- }
- #else
- fifo_xyz_data.yas532_vector_xyz[0] = sx;
- fifo_xyz_data.yas532_vector_xyz[1] = sy;
- fifo_xyz_data.yas532_vector_xyz[2] = sz;
- #endif
- if (v_busy_u8)
- return com_rslt;
- if (0 < v_overflow_s8) {
- if (!yas532_data.overflow)
- yas532_data.overflow = 1;
- yas532_data.measure_state = YAS532_MAG_STATE_INIT_COIL;
- } else
- yas532_data.overflow = 0;
- for (i = 0; i < 3; i++)
- yas532_data.last_raw[i] = v_xy1y2_u16[i];
- yas532_data.last_raw[i] = v_temp_u16;
- return com_rslt;
- }
- /*!
- * @brief This function is used to write the data acquisition
- * command register in YAS532 sensor.
- * @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_MANUAL_ENABLE)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_MANUAL_ENABLE);
- com_rslt = bmi160_set_mag_write_data(v_command_reg_data_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* YAMAHA YAS532-0x82*/
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_YAS532_COMMAND_REGISTER);
- p_bmi160->delay_msec(BMI160_YAS_ACQ_COMMAND_DELAY);
- com_rslt += bmi160_set_mag_read_addr(
- BMI160_YAS532_DATA_REGISTER);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- if (p_bmi160->mag_manual_enable == BMI160_MANUAL_ENABLE)
- com_rslt += bmi160_set_mag_manual_enable(BMI160_MANUAL_DISABLE);
- return com_rslt;
- }
- /*!
- * @brief This function is used write the offset for YAS532 sensor
- *
- * @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 is used to provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- if (p_bmi160->mag_manual_enable != BMI160_MANUAL_ENABLE)
- com_rslt = bmi160_set_mag_manual_enable(BMI160_MANUAL_ENABLE);
- p_bmi160->delay_msec(BMI160_YAS532_OFFSET_DELAY);
- /* Write offset X data*/
- com_rslt = bmi160_set_mag_write_data(p_offset_s8[0]);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* YAS532 offset x write*/
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_OFFSET_X);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* Write offset Y data*/
- com_rslt = bmi160_set_mag_write_data(p_offset_s8[1]);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* YAS532 offset y write*/
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_OFFSET_Y);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* Write offset Z data*/
- com_rslt = bmi160_set_mag_write_data(p_offset_s8[2]);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* YAS532 offset z write*/
- com_rslt += bmi160_set_mag_write_addr(BMI160_YAS532_OFFSET_Z);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- set_vector(yas532_data.v_hard_offset_s8, p_offset_s8);
- if (p_bmi160->mag_manual_enable == BMI160_MANUAL_ENABLE)
- com_rslt = bmi160_set_mag_manual_enable(BMI160_MANUAL_DISABLE);
- return com_rslt;
- }
- #endif
- #ifdef YAS537
- /***************************************************/
- /**\name FUNCTIONS FOR YAMAHA-YAS537 */
- /***************************************************/
- /*!
- * @brief This function used to init the YAMAHA-YAS537
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yamaha_yas537_mag_interface_init(
- void)
- {
- /* This variable is used to provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- u8 v_data_u8 = BMI160_INIT_VALUE;
- u8 i = BMI160_INIT_VALUE;
- u8 v_accel_power_mode_status = BMI160_INIT_VALUE;
- com_rslt = bmi160_get_accel_power_mode_stat(
- &v_accel_power_mode_status);
- /* Accel operation mode to normal*/
- if (v_accel_power_mode_status != BMI160_ACCEL_NORMAL_MODE) {
- com_rslt += bmi160_set_command_register(ACCEL_MODE_NORMAL);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- }
- /* write Mag power mode as NORMAL*/
- com_rslt += bmi160_set_mag_interface_normal();
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* Write the YAS532 i2c address*/
- com_rslt += bmi160_set_i2c_device_addr(BMI160_YAS537_I2C_ADDRESS);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* enable the Mag interface to manual mode*/
- com_rslt += bmi160_set_mag_manual_enable(BMI160_MANUAL_ENABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- bmi160_get_mag_manual_enable(&v_data_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /*Enable the MAG interface */
- com_rslt += bmi160_set_if_mode(BMI160_ENABLE_MAG_IF_MODE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- bmi160_get_if_mode(&v_data_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- v_data_u8 = BMI160_MANUAL_DISABLE;
- /* Read the YAS537 device id 0x07*/
- com_rslt += bmi160_set_mag_read_addr(BMI160_YAS_DEVICE_ID_REG);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &v_data_u8, BMI160_GEN_READ_WRITE_DATA_LENGTH);
- yas537_data.dev_id = v_data_u8;
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* Read the YAS537 calibration data*/
- com_rslt +=
- bmi160_bst_yamaha_yas537_calib_values(
- BMI160_GEN_READ_WRITE_DATA_LENGTH);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* set the mode to NORMAL*/
- yas537_data.measure_state = YAS537_MAG_STATE_NORMAL;
- /* set the transform to zero */
- yas537_data.transform = BMI160_NULL;
- yas537_data.average = 32;
- for (i = 0; i < 3; i++) {
- yas537_data.hard_offset[i] = -128;
- yas537_data.last_after_rcoil[i] = 0;
- }
- for (i = 0; i < 4; i++)
- yas537_data.last_raw[i] = 0;
- /* write the Mag bandwidth as 25Hz*/
- com_rslt += bmi160_set_mag_output_data_rate(
- BMI160_MAG_OUTPUT_DATA_RATE_25HZ);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* Enable Mag interface to auto mode*/
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_MANUAL_DISABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- bmi160_get_mag_manual_enable(&v_data_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- switch (v_accel_power_mode_status) {
- case BMI160_ACCEL_SUSPEND:
- com_rslt += bmi160_set_command_register(ACCEL_SUSPEND);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- case BMI160_ACCEL_LOW_POWER:
- com_rslt += bmi160_set_command_register(ACCEL_LOWPOWER);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- break;
- default:
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This function is used to read the
- * YAMAHA YAS537 calibration data
- *
- *
- * @param v_rcoil_u8 : The value of r coil
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yamaha_yas537_calib_values(
- u8 v_rcoil_u8)
- {
- /* This variable is used to provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array holding the YAS532 calibration values */
- u8 a_data_u8[BMI160_YAS537_CALIB_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- };
- static const u8 v_avrr_u8[] = {0x50, 0x60, 0x70};
- u8 v_cal_valid_u8 = BMI160_INIT_VALUE, i;
- /* write soft reset as 0x02*/
- com_rslt = bmi160_set_mag_write_data(
- YAS537_SRSTR_DATA);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(YAS537_REG_SRSTR);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* Read the DX value */
- com_rslt = bmi160_set_mag_read_addr(YAS537_REG_CALR_C0);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[0], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the DY1 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_C1);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[1], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the DY2 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_C2);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[2], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the D2 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_C3);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[3], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the D3 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_C4);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[4], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the D4 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_C5);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[5], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the D5 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_C6);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[6], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the D6 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_C7);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[7], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the D7 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_C8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[8], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the D8 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_C9);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[9], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the D9 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_CA);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[10], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the RX value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_CB);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[11], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the RY1 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_CC);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[12], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the RY2 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_CD);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[13], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the RY2 value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_CE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[14], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the CHF value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_CF);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[15], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* Read the VER value */
- com_rslt += bmi160_set_mag_read_addr(YAS537_REG_CALR_DO);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* 0x04 is secondary read Mag x LSB register */
- com_rslt += bmi160_read_reg(BMI160_MAG_DATA_READ_REG,
- &a_data_u8[16], BMI160_GEN_READ_WRITE_DATA_LENGTH);
- /* get the calib ver*/
- yas537_data.calib_yas537.ver =
- (a_data_u8[16] >> BMI160_SHIFT_BIT_POSITION_BY_06_BITS);
- for (i = 0; i < 17; i++) {
- if (((i < 16 && a_data_u8[i]) != 0))
- v_cal_valid_u8 = 1;
- if ((i < 16 &&
- (a_data_u8[i] & 0x3F)) != 0)
- v_cal_valid_u8 = 1;
- }
- if (!v_cal_valid_u8)
- return ERROR;
- if (yas537_data.calib_yas537.ver == 0) {
- for (i = 0; i < 17; i++) {
- if (i < 12) {
- /* write offset*/
- com_rslt += bmi160_set_mag_write_data(
- a_data_u8[i]);
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- YAS537_REG_MTCR + i);
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- } else if (i < 15) {
- /* write offset correction*/
- com_rslt += bmi160_set_mag_write_data(
- a_data_u8[i]);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr((
- (YAS537_REG_OXR + i) - 12));
- p_bmi160->delay_msec(
- BMI160_GEN_READ_WRITE_DELAY);
- yas537_data.hard_offset[i - 12]
- = a_data_u8[i];
- } else {
- /* write offset correction*/
- com_rslt += bmi160_set_mag_write_data(
- a_data_u8[i]);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr((
- (YAS537_REG_OXR + i) - 11));
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- }
- }
- } else if (yas537_data.calib_yas537.ver == 1) {
- for (i = 0; i < 3; i++) {
- /* write offset*/
- com_rslt += bmi160_set_mag_write_data(
- a_data_u8[i]);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- YAS537_REG_MTCR + i);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- if (com_rslt == SUCCESS) {
- /* write offset*/
- com_rslt += bmi160_set_mag_write_data(
- a_data_u8[i + 12]);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- YAS537_REG_OXR + i);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- yas537_data.hard_offset[i] =
- a_data_u8[i + 12];
- } else {
- com_rslt = ERROR;
- }
- }
- /* write offset*/
- com_rslt += bmi160_set_mag_write_data(
- ((a_data_u8[i] & 0xE0) | 0x10));
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(
- YAS537_REG_MTCR + i);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* write offset*/
- com_rslt += bmi160_set_mag_write_data(
- ((a_data_u8[15]
- >> BMI160_SHIFT_BIT_POSITION_BY_03_BITS)
- & 0x1E));
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(YAS537_REG_HCKR);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* write offset*/
- com_rslt += bmi160_set_mag_write_data(
- ((a_data_u8[15] << 1) & 0x1E));
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(YAS537_REG_LCKR);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* write offset*/
- com_rslt += bmi160_set_mag_write_data(
- (a_data_u8[16] & 0x3F));
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(YAS537_REG_OCR);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* Assign the calibration values*/
- /* a2 */
- yas537_data.calib_yas537.a2 =
- ((((a_data_u8[3]
- << BMI160_SHIFT_BIT_POSITION_BY_02_BITS)
- & 0x7C)
- | (a_data_u8[4]
- >> BMI160_SHIFT_BIT_POSITION_BY_06_BITS)) - 64);
- /* a3 */
- yas537_data.calib_yas537.a3 =
- ((((a_data_u8[4] << BMI160_SHIFT_BIT_POSITION_BY_01_BIT)
- & 0x7E)
- | (a_data_u8[5]
- >> BMI160_SHIFT_BIT_POSITION_BY_07_BITS)) - 64);
- /* a4 */
- yas537_data.calib_yas537.a4 =
- ((((a_data_u8[5]
- << BMI160_SHIFT_BIT_POSITION_BY_01_BIT)
- & 0xFE)
- | (a_data_u8[6]
- >> BMI160_SHIFT_BIT_POSITION_BY_07_BITS))
- - 128);
- /* a5 */
- yas537_data.calib_yas537.a5 =
- ((((a_data_u8[6]
- << BMI160_SHIFT_BIT_POSITION_BY_02_BITS)
- & 0x1FC)
- | (a_data_u8[7]
- >> BMI160_SHIFT_BIT_POSITION_BY_06_BITS))
- - 112);
- /* a6 */
- yas537_data.calib_yas537.a6 =
- ((((a_data_u8[7]
- << BMI160_SHIFT_BIT_POSITION_BY_01_BIT)
- & 0x7E)
- | (a_data_u8[8]
- >> BMI160_SHIFT_BIT_POSITION_BY_07_BITS)) - 64);
- /* a7 */
- yas537_data.calib_yas537.a7 =
- ((((a_data_u8[8]
- << BMI160_SHIFT_BIT_POSITION_BY_01_BIT)
- & 0xFE)
- | (a_data_u8[9]
- >> BMI160_SHIFT_BIT_POSITION_BY_07_BITS))
- - 128);
- /* a8 */
- yas537_data.calib_yas537.a8 = ((a_data_u8[9] &
- 0x7F) - 64);
- /* a9 */
- yas537_data.calib_yas537.a9 = ((((a_data_u8[10]
- << BMI160_SHIFT_BIT_POSITION_BY_01_BIT) & 0x1FE)
- | (a_data_u8[11]
- >> BMI160_SHIFT_BIT_POSITION_BY_07_BITS))
- - 112);
- /* k */
- yas537_data.calib_yas537.k = (
- a_data_u8[11] & 0x7F);
- } else {
- return ERROR;
- }
- /* write A/D converter*/
- com_rslt += bmi160_set_mag_write_data(
- YAS537_WRITE_A_D_CONVERTER);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(YAS537_REG_ADCCALR);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* write A/D converter second register*/
- com_rslt += bmi160_set_mag_write_data(
- YAS537_WRITE_A_D_CONVERTER2);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(YAS537_REG_ADCCALR_ONE);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* write temperature calibration register*/
- com_rslt += bmi160_set_mag_write_data(YAS537_WRITE_TEMP_CALIB);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(YAS537_REG_TRMR);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- /* write average filter register*/
- com_rslt += bmi160_set_mag_write_data(
- v_avrr_u8[yas537_data.average]);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(YAS537_REG_AVRR);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- if (v_rcoil_u8) {
- /* write average; filter register*/
- com_rslt += bmi160_set_mag_write_data(
- YAS537_WRITE_FILTER);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(YAS537_REG_CONFR);
- p_bmi160->delay_msec(
- BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- }
- return com_rslt;
- }
- /*!
- * @brief This function is used for writing the data acquisition
- * command register write in YAS537
- * @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_yas537_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_MANUAL_ENABLE)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_MANUAL_ENABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt = bmi160_set_mag_write_data(v_command_reg_data_u8);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- /* YAMAHA YAS532-0x82*/
- com_rslt += bmi160_set_mag_write_addr(
- BMI160_REG_YAS537_CMDR);
- /* set the mode to RECORD*/
- yas537_data.measure_state = YAS537_MAG_STATE_RECORD_DATA;
- p_bmi160->delay_msec(BMI160_YAS_ACQ_COMMAND_DELAY);
- com_rslt += bmi160_set_mag_read_addr(
- YAS537_REG_TEMPERATURE_0);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- if (p_bmi160->mag_manual_enable == BMI160_MANUAL_ENABLE)
- com_rslt += bmi160_set_mag_manual_enable(
- BMI160_MANUAL_DISABLE);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- return com_rslt;
- }
- /*!
- * @brief This function is used for processing the
- * YAMAHA YAS537 xy1y2 raw data
- *
- * @param xy1y2: The value of raw xy1y2 data
- * @param xyz: The value of xyz data
- *
- *
- * @return None
- *
- *
- */
- static void xy1y2_to_xyz(u16 *xy1y2, s32 *xyz)
- {
- xyz[0] = ((xy1y2[0] - 8192)
- * 300);
- xyz[1] = (((xy1y2[1] - xy1y2[2])
- * 1732) / 10);
- xyz[2] = (((-xy1y2[2] - xy1y2[2])
- + 16384) * 300);
- }
- /*!
- * @brief This function is used to read the
- * YAMAHA YAS537 xy1y2 data
- *
- * @param v_coil_stat_u8: The value of R coil status
- * @param v_busy_u8: The value of busy status
- * @param v_temperature_u16: The value of temperature
- * @param xy1y2: The value of raw xy1y2 data
- * @param v_outflow_u8: The value of overflow
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yamaha_yas537_read_xy1y2_data(
- u8 *v_coil_stat_u8, u8 *v_busy_u8,
- u16 *v_temperature_u16, u16 *xy1y2, u8 *v_outflow_u8)
- {
- /* This variable is used to provide the communication
- results*/
- BMI160_RETURN_FUNCTION_TYPE com_rslt = E_BMI160_COMM_RES;
- /* Array holding the YAS532 calibration values */
- u8 a_data_u8[BMI160_YAS_XY1Y2T_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE,
- };
- u8 i = BMI160_INIT_VALUE;
- s32 a_h_s32[BMI160_YAS_H_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- s32 a_s_s32[BMI160_YAS_S_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- /* set command register*/
- com_rslt = bmi160_bst_yas537_acquisition_command_register(
- YAS537_SET_COMMAND_REGISTER);
- /* read the yas537 sensor data of xy1y2*/
- com_rslt +=
- p_bmi160->BMI160_BUS_READ_FUNC(p_bmi160->dev_addr,
- BMI160_USER_DATA_MAG_X_LSB__REG,
- a_data_u8, BMI160_MAG_YAS_DATA_LENGTH);
- /* read the busy flag*/
- *v_busy_u8 = a_data_u8[2]
- >> BMI160_SHIFT_BIT_POSITION_BY_07_BITS;
- /* read the coil status*/
- *v_coil_stat_u8 =
- ((a_data_u8[2] >>
- BMI160_SHIFT_BIT_POSITION_BY_06_BITS) & 0X01);
- /* read temperature data*/
- *v_temperature_u16 = (u16)((a_data_u8[0]
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS) | a_data_u8[1]);
- /* read x data*/
- xy1y2[0] = (u16)(((a_data_u8[2] &
- 0x3F)
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | (a_data_u8[3]));
- /* read y1 data*/
- xy1y2[1] = (u16)((a_data_u8[4]
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | a_data_u8[5]);
- /* read y2 data*/
- xy1y2[2] = (u16)((a_data_u8[6]
- << BMI160_SHIFT_BIT_POSITION_BY_08_BITS)
- | a_data_u8[7]);
- for (i = 0; i < 3; i++)
- yas537_data.last_raw[i] = xy1y2[i];
- yas537_data.last_raw[i] = *v_temperature_u16;
- if (yas537_data.calib_yas537.ver == 1) {
- for (i = 0; i < 3; i++)
- a_s_s32[i] = xy1y2[i] - 8192;
- /* read hx*/
- a_h_s32[0] = ((yas537_data.calib_yas537.k * (
- (128 * a_s_s32[0]) +
- (yas537_data.calib_yas537.a2 * a_s_s32[1]) +
- (yas537_data.calib_yas537.a3 * a_s_s32[2])))
- / (8192));
- /* read hy1*/
- a_h_s32[1] = ((yas537_data.calib_yas537.k * (
- (yas537_data.calib_yas537.a4 * a_s_s32[0]) +
- (yas537_data.calib_yas537.a5 * a_s_s32[1]) +
- (yas537_data.calib_yas537.a6 * a_s_s32[2])))
- / (8192));
- /* read hy2*/
- a_h_s32[2] = ((yas537_data.calib_yas537.k * (
- (yas537_data.calib_yas537.a7 * a_s_s32[0]) +
- (yas537_data.calib_yas537.a8 * a_s_s32[1]) +
- (yas537_data.calib_yas537.a9 * a_s_s32[2])))
- / (8192));
- for (i = 0; i < 3; i++) {
- if (a_h_s32[i] < -8192)
- a_h_s32[i] = -8192;
- if (8192 < a_h_s32[i])
- a_h_s32[i] = 8192;
- xy1y2[i] = a_h_s32[i] + 8192;
- }
- }
- *v_outflow_u8 = 0;
- for (i = 0; i < 3; i++) {
- if (YAS537_DATA_OVERFLOW <= xy1y2[i])
- *v_outflow_u8 |= (1 << (i * 2));
- if (xy1y2[i] == YAS537_DATA_UNDERFLOW)
- *v_outflow_u8 |= (1 << (i * 2 + 1));
- }
- return com_rslt;
- }
- /*!
- * @brief This function is used for detecting whether the mag
- * data obtained is valid or not
- *
- *
- * @param v_cur_u16: The value of current Mag data
- * @param v_last_u16: The value of last Mag data
- *
- *
- * @return results of magnetic field data's validity
- * @retval 0 -> VALID DATA
- * @retval 1 -> INVALID DATA
- *
- *
- */
- static BMI160_RETURN_FUNCTION_TYPE invalid_magnetic_field(
- u16 *v_cur_u16, u16 *v_last_u16)
- {
- s16 invalid_thresh[] = {1500, 1500, 1500};
- u8 i = BMI160_INIT_VALUE;
- for (i = 0; i < 3; i++)
- if (invalid_thresh[i] < ABS(v_cur_u16[i] - v_last_u16[i]))
- return 1;
- return 0;
- }
- /*!
- * @brief This function is used to read the
- * YAMAHA YAS537 xy1y2 data
- *
- * @param v_outflow_u8: The value of overflow
- * @param *vector_xyz : yas vector structure pointer
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yamaha_yas537_measure_xyz_data(
- u8 *v_outflow_u8, struct yas_vector *vector_xyz)
- {
- s32 a_xyz_tmp_s32[BMI160_YAS_TEMP_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- u8 i = BMI160_INIT_VALUE;
- s8 com_rslt = BMI160_INIT_VALUE;
- u8 v_busy_u8 = BMI160_INIT_VALUE;
- u8 v_rcoil_u8 = BMI160_INIT_VALUE;
- u16 v_temperature_u16 = BMI160_INIT_VALUE;
- u16 a_xy1y2_u16[BMI160_YAS_XY1Y2_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- *v_outflow_u8 = 0;
- /* read the yas537 xy1y2 data*/
- com_rslt = bmi160_bst_yamaha_yas537_read_xy1y2_data(
- &v_rcoil_u8, &v_busy_u8,
- &v_temperature_u16, a_xy1y2_u16, v_outflow_u8);
- /* linear calculation*/
- xy1y2_to_xyz(a_xy1y2_u16, vector_xyz->yas537_vector_xyz);
- if (yas537_data.transform != BMI160_NULL) {
- for (i = 0; i < 3; i++) {
- a_xyz_tmp_s32[i] = ((
- yas537_data.transform[i + 3]
- * vector_xyz->yas537_vector_xyz[0])
- + (yas537_data.transform[
- i * 3 + 1]
- * vector_xyz->yas537_vector_xyz[1])
- + (yas537_data.transform[
- i * 3 + 2]
- * vector_xyz->yas537_vector_xyz[2]));
- }
- yas537_set_vector(
- vector_xyz->yas537_vector_xyz, a_xyz_tmp_s32);
- }
- for (i = 0; i < 3; i++) {
- vector_xyz->yas537_vector_xyz[i] -=
- vector_xyz->yas537_vector_xyz[i] % 10;
- if (*v_outflow_u8 & (1 <<
- (i * 2)))
- vector_xyz->yas537_vector_xyz[i] +=
- 1; /* set overflow */
- if (*v_outflow_u8 & (1 << (i * 2 + 1)))
- /* set underflow */
- vector_xyz->yas537_vector_xyz[i] += 2;
- }
- if (v_busy_u8)
- return ERROR;
- switch (yas537_data.measure_state) {
- case YAS537_MAG_STATE_INIT_COIL:
- if (p_bmi160->mag_manual_enable != BMI160_MANUAL_ENABLE)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_MANUAL_ENABLE);
- com_rslt += bmi160_set_mag_write_data(YAS537_WRITE_CONFR);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(YAS537_REG_CONFR);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- yas537_data.measure_state = YAS537_MAG_STATE_RECORD_DATA;
- if (p_bmi160->mag_manual_enable == BMI160_MANUAL_ENABLE)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_MANUAL_DISABLE);
- break;
- case YAS537_MAG_STATE_RECORD_DATA:
- if (v_rcoil_u8)
- break;
- yas537_set_vector(yas537_data.last_after_rcoil, a_xy1y2_u16);
- yas537_data.measure_state = YAS537_MAG_STATE_NORMAL;
- break;
- case YAS537_MAG_STATE_NORMAL:
- if (BMI160_INIT_VALUE < v_outflow_u8
- || invalid_magnetic_field(a_xy1y2_u16,
- yas537_data.last_after_rcoil)) {
- yas537_data.measure_state = YAS537_MAG_STATE_INIT_COIL;
- for (i = 0; i < 3; i++) {
- if (!*v_outflow_u8)
- vector_xyz->yas537_vector_xyz[i] += 3;
- }
- }
- break;
- }
- return com_rslt;
- }
- /*!
- * @brief This function is used to read the
- * YAMAHA YAS537 xy1y2 data of fifo
- *
- * @param a_xy1y2_u16: The value of xyy1 data
- * @param v_over_flow_u8: The value of overflow
- * @param v_rcoil_u8: The value of rcoil
- * @param v_busy_u8: The value of busy flag
- *
- *
- * @return results of bus communication function
- * @retval 0 -> Success
- * @retval -1 -> Error
- *
- *
- */
- BMI160_RETURN_FUNCTION_TYPE bmi160_bst_yamaha_yas537_fifo_xyz_data(
- u16 *a_xy1y2_u16, u8 v_over_flow_u8, u8 v_rcoil_u8, u8 v_busy_u8)
- {
- s32 a_xyz_tmp_s32[BMI160_YAS_TEMP_DATA_SIZE] = {
- BMI160_INIT_VALUE, BMI160_INIT_VALUE, BMI160_INIT_VALUE};
- u8 i = BMI160_INIT_VALUE;
- s8 com_rslt = BMI160_INIT_VALUE;
- /* linear calculation*/
- xy1y2_to_xyz(a_xy1y2_u16, fifo_vector_xyz.yas537_vector_xyz);
- if (yas537_data.transform != BMI160_NULL) {
- for (i = 0; i < 3; i++) {
- a_xyz_tmp_s32[i] = ((
- yas537_data.transform[i + 3]
- * fifo_vector_xyz.yas537_vector_xyz[0])
- + (yas537_data.transform[
- i * 3 + 1]
- * fifo_vector_xyz.yas537_vector_xyz[1])
- + (yas537_data.transform[
- i * 3 + 2]
- * fifo_vector_xyz.yas537_vector_xyz[2]));
- }
- yas537_set_vector(
- fifo_vector_xyz.yas537_vector_xyz, a_xyz_tmp_s32);
- }
- for (i = 0; i < 3; i++) {
- fifo_vector_xyz.yas537_vector_xyz[i] -=
- fifo_vector_xyz.yas537_vector_xyz[i] % 10;
- if (v_over_flow_u8 & (1 <<
- (i * 2)))
- fifo_vector_xyz.yas537_vector_xyz[i] +=
- 1; /* set overflow */
- if (v_over_flow_u8 & (1 << (i * 2 + 1)))
- /* set underflow */
- fifo_vector_xyz.yas537_vector_xyz[i] += 2;
- }
- if (v_busy_u8)
- return ERROR;
- switch (yas537_data.measure_state) {
- case YAS537_MAG_STATE_INIT_COIL:
- if (p_bmi160->mag_manual_enable != BMI160_MANUAL_ENABLE)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_MANUAL_ENABLE);
- com_rslt += bmi160_set_mag_write_data(YAS537_WRITE_CONFR);
- p_bmi160->delay_msec(BMI160_GEN_READ_WRITE_DELAY);
- com_rslt += bmi160_set_mag_write_addr(YAS537_REG_CONFR);
- p_bmi160->delay_msec(BMI160_SEC_INTERFACE_GEN_READ_WRITE_DELAY);
- yas537_data.measure_state = YAS537_MAG_STATE_RECORD_DATA;
- if (p_bmi160->mag_manual_enable == BMI160_MANUAL_ENABLE)
- com_rslt = bmi160_set_mag_manual_enable(
- BMI160_MANUAL_DISABLE);
- break;
- case YAS537_MAG_STATE_RECORD_DATA:
- if (v_rcoil_u8)
- break;
- yas537_set_vector(yas537_data.last_after_rcoil, a_xy1y2_u16);
- yas537_data.measure_state = YAS537_MAG_STATE_NORMAL;
- break;
- case YAS537_MAG_STATE_NORMAL:
- if (BMI160_INIT_VALUE < v_over_flow_u8
- || invalid_magnetic_field(a_xy1y2_u16,
- yas537_data.last_after_rcoil)) {
- yas537_data.measure_state = YAS537_MAG_STATE_INIT_COIL;
- for (i = 0; i < 3; i++) {
- if (!v_over_flow_u8)
- fifo_vector_xyz.yas537_vector_xyz[i]
- += 3;
- }
- }
- break;
- }
- return com_rslt;
- }
- #endif
|